CN116360462B - Obstacle avoidance method of netting cleaning robot - Google Patents

Obstacle avoidance method of netting cleaning robot Download PDF

Info

Publication number
CN116360462B
CN116360462B CN202310462492.5A CN202310462492A CN116360462B CN 116360462 B CN116360462 B CN 116360462B CN 202310462492 A CN202310462492 A CN 202310462492A CN 116360462 B CN116360462 B CN 116360462B
Authority
CN
China
Prior art keywords
netting
net
robot
obstacle
cleaning robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202310462492.5A
Other languages
Chinese (zh)
Other versions
CN116360462A (en
Inventor
江文亮
王丹
徐超
马春田
曾叶强
于敬东
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao Sencott Intelligent Instrument Co ltd
Original Assignee
Qingdao Sencott Intelligent Instrument Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Qingdao Sencott Intelligent Instrument Co ltd filed Critical Qingdao Sencott Intelligent Instrument Co ltd
Priority to CN202310462492.5A priority Critical patent/CN116360462B/en
Publication of CN116360462A publication Critical patent/CN116360462A/en
Application granted granted Critical
Publication of CN116360462B publication Critical patent/CN116360462B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A40/00Adaptation technologies in agriculture, forestry, livestock or agroalimentary production
    • Y02A40/80Adaptation technologies in agriculture, forestry, livestock or agroalimentary production in fisheries management
    • Y02A40/81Aquaculture, e.g. of fish

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Cleaning By Liquid Or Steam (AREA)

Abstract

The application provides an obstacle avoidance method of a netting cleaning robot, which assists an operator to remotely control an underwater robot to leave attached netting by switching a robot control mode, and automatically maintains the current gesture, heading and water depth, thereby realizing large-range obstacle crossing without deviating from the original track. Is an automatic auxiliary driving function for an underwater cleaning robot. The application has the advantages that the robot does not return to the horizontal state parallel to the sea level due to the return moment (the self-stabilizing force of the robot under water caused by the different points of the floating center and the gravity center) during obstacle crossing, but keeps parallel to the netting. Thereby remarkably reducing the driving difficulty of operators.

Description

Obstacle avoidance method of netting cleaning robot
Technical Field
The application relates to the technical field of sea cage culture, in particular to an obstacle avoidance method of a net cleaning robot.
Background
The netting in cage culture provides a proper environment for the growth of organisms such as various algae, shellfish and the like, and the permeability of the meshes is related to whether the cultured products can grow normally, so that the netting is cleaned to be one of important work for cage culture. However, due to the necessary fixing and supporting structures in the design of the net cage, some objects left behind and the like, the net cleaning robot becomes an obstacle in work, so that the net cleaning robot has a certain obstacle crossing capability. In some deep open sea cages, the need for obstacle surmounting capability is particularly pronounced with the usual steel structure or coarse rope designs.
At present, a plurality of enterprises develop products and cleaning methods for the netting at home and abroad. CN113275295 discloses that the use of tracks as running gear shows a spiral descending cleaning method and no obstacle surmounting is described. The robot for washing the net developed on the market at present usually uses a crawler belt as a travelling mechanism or uses a propeller to slide as a travelling mode, but in some complex net cases, the net adopts a hanging piece type structure, a plurality of net clothes are separated by the upright posts of the net case and are not communicated into a whole, when the robot is blocked by the upright posts with thick steel structures, the crawler belt is difficult to pass under the lubrication conditions of smooth outer surfaces and water, and the rugged barrier surface makes the sliding mode impossible.
Disclosure of Invention
In order to make up for the defects of the prior art, the application provides an obstacle avoidance method of a netting cleaning robot.
The application is realized by the following technical scheme: the obstacle avoidance method of the netting cleaning robot comprises netting, an obstacle arranged on the netting and the netting cleaning robot, and specifically comprises the following steps:
step S1, controlling a netting cleaning robot to normally execute a netting cleaning task by attaching a netting in a net cage, calculating quaternion and depth data at moment by the robot, and finding that the netting cleaning robot encounters an obstacle in a video, wherein the attitude quaternion of the robot isDepth of water->
S2, controlling the netting cleaning robot to switch from a net washing mode to a robot flight mode, and automatically reading and storing attitude quaternions during net washing by the netting cleaning robotDeep water->And (3) net pressing force>
Step S3, the netting cleaning robot takes the posture quaternion saved in the step S2For the attitude target value, the attitude is kept by adopting an attitude-angular velocity double closed loop +.>The depth is kept by adopting a water depth closed loop>Recovering the net pressing force of the propeller>So that the net pressing force is->At the moment, the net cleaning robot no longer has net pressing force, and automatically keeps the posture +.>Depth and depth of
S4, the net cleaning robot completely maintains pitch angle, roll angle, course angle and depth; due to the net pressing forceThe robot cannot cling to the netting and gradually floats away from the netting, and leaves a distance L in a preset cleaning route;
s5, observing video of the camera and height of the obstacleWhen L>/>When the robot is controlled to fly over the obstacle, the gesture quaternion is +.>Keep unchanged, water depth->Remain unchanged;
step S6, after the net cleaning robot passes over the obstacle, increasing net pressing forceUp to->The posture quaternion is still kept before the clothes are attached>Deep water->
S7, after the robot is attached to the netting, the posture and the depth are not kept any more, the netting cleaning robot is controlled to switch from a flying mode to a cleaning mode, at the moment, the power of the vertical propeller of the robot is completely distributed to the netting cleaning robot with the netting pressing function to attach the netting, and the netting pressing force is applied to the netting cleaning robot
S8, the netting cleaning robot continues to execute cleaning tasks according to a set plan;
and step S9, repeatedly executing the operations from step S2 to step S8 after encountering the obstacle again.
Preferably, the obstacle is one of a vertical column obstacle, an inclined obstacle and a net cage sequelae.
The application adopts the technical proposal, and compared with the prior art, the application has the following beneficial effects: the prior literature does not discuss in detail the operation or obstacle avoidance method which is used when the net washing robot encounters a large obstacle such as a stand column, and the like, according to engineering practice experience, supposes that two traditional modes exist when the net washing robot encounters the situation, one is the net washing robot without a swimming function, and the robot needs to be lifted manually by using a crane or the like, and is lowered again at the other end of the stand column obstacle. Yet another method is for the robot to shut off the net force and disengage from the netting, at which point the robot returns to an original position under the force of buoyancy and gravity, and the operator controls the robot to use the swimming function to clear the obstacle.
According to the application, by automatically reading the gesture and water depth data before off-grid, and adopting the angular speed, gesture double-closed-loop PID and depth closed-loop PID formed by matrix operation of quaternion, the gesture and depth of the robot before off-grid can still be maintained under the condition of off-grid clothing, and when depth adjustment is required, the robot can also ensure controllable adjustment of depth. After obstacle surmounting, operators can complete the net pasting and still can be attached to the position of the established netting, so that the operators can completely realize correct obstacle surmounting and path planning according to the planning. The robot control mode is switched to assist an operator to remotely control the underwater robot to leave the attached netting, and the current gesture, heading and water depth are automatically kept, so that the large-range crossing obstacle without deviating from the original track is realized; is an automatic auxiliary driving function for an underwater cleaning robot.
The application has the advantages that the robot does not need to be lifted again when the obstacle is surmounted, thereby reducing the workload of operators; the robot can keep the original gesture and depth when crossing the obstacle, and can keep the original travelling path to realize obstacle crossing, so that sufficient cleaning coverage rate when the robot is remotely controlled to clean the net is ensured; when the obstacle surmounting, the robot does not return to a horizontal state parallel to the sea level again due to the restoring moment (the self-stabilizing force of the robot under water caused by the different points of the floating center and the gravity center), but keeps parallel to the netting. Thereby remarkably reducing the driving difficulty of operators.
Additional aspects and advantages of the application will be set forth in part in the description which follows, or may be learned by practice of the application.
Drawings
The foregoing and/or additional aspects and advantages of the application will become apparent and may be better understood from the following description of embodiments taken in conjunction with the accompanying drawings in which:
fig. 1 is a view showing a state in which a net washing robot is normally cleaned under water.
Fig. 2 is a top view of the robot for washing a net when encountering a vertical obstacle in the operating state of fig. 1.
Fig. 3 is a top view of the robot from the netting with the robot maintaining pose and depth.
Fig. 4 is a top view of the robot cleaner when the robot cleaner maintains the posture of fig. 2 across an obstacle.
Fig. 5 is a plan view of the net washing robot when the net pressing force is increased after crossing an obstacle.
Fig. 6 is a plan view of the net washing robot when the net is attached to the net after the net pressing force is applied.
Fig. 7 is a front view of a washing robot encountering a vertical obstacle cleaning trajectory.
Fig. 8 is a flowchart of a cleaning robot obstacle crossing method.
Wherein, the correspondence between the reference numerals and the components in fig. 1 to 7 is:
1. an obstacle; 2. A netting; 3. A robot; 4. the more vertical the pre-fault cleaning track; 5. the cleaning track after crossing the vertical barrier.
Detailed Description
In order that the above-recited objects, features and advantages of the present application will be more clearly understood, a more particular description of the application will be rendered by reference to the appended drawings and appended detailed description. It should be noted that, without conflict, the embodiments of the present application and features in the embodiments may be combined with each other.
In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present application, however, the present application may be practiced otherwise than as described herein, and therefore the scope of the present application is not limited to the specific embodiments disclosed below.
The obstacle avoidance method of the netting cleaning robot according to the embodiment of the application is specifically described below with reference to fig. 1 to 8.
The obstacle surmounting method of the net cleaning robot 3 is described in detail by taking a large-sized steel structure upright post as an obstacle, and specifically comprises the following steps as shown in fig. 1-6:
step S1, as shown in FIG. 1, the operator controls the netting cleaning robot (3)The net washing task is normally executed by attaching the net (2) in the net cage, the robot (3) still calculates quaternion and depth data at any time, and an operator finds that the net washing robot (3) encounters an obstacle (1) in a video, as shown in fig. 2, at the moment, the attitude quaternion of the robot (3) is as followsDepth of water->
S2, an operator controls the netting cleaning robot (3) to switch from a net washing mode to a robot flight mode, and the netting cleaning robot (3) automatically reads and stores attitude quaternions during net washingDeep water->Net pressing force
S3, the netting cleaning robot (3) takes the attitude quaternion saved in S2For the attitude target value, the attitude is kept by adopting an attitude-angular velocity double closed loop +.>The depth is kept by adopting a water depth closed loop>Recovering the net pressing force of the propellerSo that the net pressing force is->At this time, the net cleaning robot (3) no longer has net pressing force, but automatically keeps the posture +.>And depth->
Step S4, as shown in FIG. 3, the net cleaning robot (3) completely maintains pitch angle, roll angle, course angle and depth; due to the net pressing forceThe robot cannot cling to the netting and gradually floats away from the netting, and leaves a certain distance L in a preset cleaning route;
step S5, as shown in FIG. 4, the operator observes the video of the camera, the height of the obstacle (1)When L>During the operation, the netting cleaning robot (3) flies over the obstacle (1), and the posture quaternion is +.>Deep water->Remain unchanged;
step S6, as shown in FIG. 5, after the net cleaning robot (3) passes over the obstacle (1), the net pressing force is increasedUp toBefore the net (2) is attached, the posture quaternion is still kept>Deep water->
Step S7, as shown in FIG. 6, the posture and depth are not kept after the robot is attached to the netting (2), an operator controls the netting cleaning robot (3) to switch from a flight mode to a cleaning mode, and at the moment, the power of the vertical propeller of the robot is completely distributed to the netting cleaning robot (3) with the net pressing function to attach to the netting (2), and the net pressing force is applied to the netting cleaning robot
S8, the netting cleaning robot (3) continues to execute cleaning tasks according to a set plan;
and step S9, repeatedly executing the operations from step S2 to step S8 after encountering the obstacle (1) again.
The cleaning paths before and after obstacle crossing of the netting cleaning robot are shown in fig. 7.
In the description of the present application, the term "plurality" means two or more, unless explicitly defined otherwise, the orientation or positional relationship indicated by the terms "upper", "lower", etc. are based on the orientation or positional relationship shown in the drawings, merely for convenience of description of the present application and to simplify the description, and do not indicate or imply that the apparatus or elements referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be construed as limiting the present application; the terms "coupled," "mounted," "secured," and the like are to be construed broadly, and may be fixedly coupled, detachably coupled, or integrally connected, for example; can be directly connected or indirectly connected through an intermediate medium. The specific meaning of the above terms in the present application can be understood by those of ordinary skill in the art according to the specific circumstances.
In the description of the present specification, the terms "one embodiment," "some embodiments," "particular embodiments," and the like, mean that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the present application. In this specification, schematic representations of the above terms do not necessarily refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
The above is only a preferred embodiment of the present application, and is not intended to limit the present application, but various modifications and variations can be made to the present application by those skilled in the art. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the protection scope of the present application.

Claims (2)

1. The obstacle avoidance method of the netting cleaning robot comprises a netting (2), an obstacle (1) arranged on the netting (2) and the netting cleaning robot (3), and is characterized by comprising the following steps of:
step S1, controlling a netting cleaning robot (3) to cling to a netting (2) in a net cage to normally execute a netting cleaning task, calculating quaternion and depth data at moment of the robot (3), and finding that the netting cleaning robot (3) encounters an obstacle (1) in a video, wherein the attitude quaternion of the robot (3) is Q object Depth of water H object
S2, controlling the netting cleaning robot (3) to switch from a net washing mode to a robot flight mode, and automatically reading and storing an attitude quaternion Q when the netting cleaning robot (3) washes the net object Depth of water H object And net pressing force F object
S3, the netting cleaning robot (3) takes the posture quaternion Q saved in S2 object For the attitude target value, adopting an attitude-angular speed double closed loop to maintain an attitude quaternion Q object Maintaining water depth H by adopting water depth closed loop object Recovering the net pressing force F of the propeller press So that the net pressing force F press =0, at this time, the net cleaning robot (3) no longer has net pressing force, and automatically maintains the posture quaternion Q object And depth of water H object
S4, the net cleaning robot (3) completely maintains pitch angle, roll angle, course angle and depth; due to the net pressing force F press =0, the robot cannot cling to the netting and gradually floats away from the netting, and leaves a distance L in a predetermined cleaning route;
step S5, observing the cameraVideo, height H of obstacle (1) obstacle When L > H obstacle During the operation, the netting cleaning robot (3) flies over the obstacle (1), and the posture quaternion Q object Keep unchanged, the water depth H object Remain unchanged;
s6, after the net cleaning robot (3) passes over the obstacle (1), increasing the net pressing force F press Up to F press =F object The attitude quaternion Q is still maintained before the clothes (2) are attached object Depth of water H object
S7, after the net (2) is attached, the posture and the depth are not kept any more, the net cleaning robot (3) is controlled to be switched from a flight mode to a cleaning mode, at the moment, the power of the vertical propeller of the robot is completely distributed to the net cleaning robot (3) with the net pressing function to attach the net (2), and the net pressing force F is applied to the net cleaning robot press =F object
S8, the netting cleaning robot (3) continues to execute cleaning tasks according to a set plan;
and step S9, repeatedly executing the operations from step S2 to step S8 after encountering the obstacle (1) again.
2. The obstacle avoidance method of a netting washing robot of claim 1 wherein the obstacle (1) is one of a vertical column obstacle, an inclined obstacle, and a net cage sequela.
CN202310462492.5A 2023-04-26 2023-04-26 Obstacle avoidance method of netting cleaning robot Active CN116360462B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310462492.5A CN116360462B (en) 2023-04-26 2023-04-26 Obstacle avoidance method of netting cleaning robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310462492.5A CN116360462B (en) 2023-04-26 2023-04-26 Obstacle avoidance method of netting cleaning robot

Publications (2)

Publication Number Publication Date
CN116360462A CN116360462A (en) 2023-06-30
CN116360462B true CN116360462B (en) 2023-09-26

Family

ID=86923006

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310462492.5A Active CN116360462B (en) 2023-04-26 2023-04-26 Obstacle avoidance method of netting cleaning robot

Country Status (1)

Country Link
CN (1) CN116360462B (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07248817A (en) * 1994-03-12 1995-09-26 Nec Corp Underwater running machine
JP2008052473A (en) * 2006-08-24 2008-03-06 Nippon Telegr & Teleph Corp <Ntt> Operation control method and device for underwater robot, program and its recording medium
US8712679B1 (en) * 2010-10-29 2014-04-29 Stc.Unm System and methods for obstacle mapping and navigation
CN104571128A (en) * 2014-12-26 2015-04-29 燕山大学 Obstacle avoidance method used for underwater robot and based on distance and parallax information
EP3293326A1 (en) * 2016-09-13 2018-03-14 Maytronics Ltd. Master and slave pool cleaning robots
CN109828606A (en) * 2019-03-21 2019-05-31 青岛罗博飞海洋技术有限公司 A kind of underwater net cage cruising inspection system
CN113120202A (en) * 2021-05-26 2021-07-16 智真海洋科技(威海)有限公司 Intelligent cleaning robot suitable for underwater environment cleaning
CN115185282A (en) * 2022-08-05 2022-10-14 智橙动力(北京)科技有限公司 Pool wall obstacle avoidance moving method and device of swimming pool cleaning robot and electronic equipment

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11504607B2 (en) * 2019-02-05 2022-11-22 Deep Innovations Ltd. System and method for using a camera unit for the pool cleaning robot for safety monitoring and augmented reality games
CN112342970A (en) * 2019-08-07 2021-02-09 三赢科技(深圳)有限公司 Intelligent environment cleaning robot

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07248817A (en) * 1994-03-12 1995-09-26 Nec Corp Underwater running machine
JP2008052473A (en) * 2006-08-24 2008-03-06 Nippon Telegr & Teleph Corp <Ntt> Operation control method and device for underwater robot, program and its recording medium
US8712679B1 (en) * 2010-10-29 2014-04-29 Stc.Unm System and methods for obstacle mapping and navigation
CN104571128A (en) * 2014-12-26 2015-04-29 燕山大学 Obstacle avoidance method used for underwater robot and based on distance and parallax information
EP3293326A1 (en) * 2016-09-13 2018-03-14 Maytronics Ltd. Master and slave pool cleaning robots
CN109828606A (en) * 2019-03-21 2019-05-31 青岛罗博飞海洋技术有限公司 A kind of underwater net cage cruising inspection system
CN113120202A (en) * 2021-05-26 2021-07-16 智真海洋科技(威海)有限公司 Intelligent cleaning robot suitable for underwater environment cleaning
CN115185282A (en) * 2022-08-05 2022-10-14 智橙动力(北京)科技有限公司 Pool wall obstacle avoidance moving method and device of swimming pool cleaning robot and electronic equipment

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Adaptive motion planning and path following for permanent resident biofouling prevention robot operating in fish farms;Martin Føre;IEEE;第1-10页 *
一种新型深海网箱网衣清洗机器人设计;庄集超,庞洪臣,刘子浪,张德立,江佳涛;机器人技术;第72-75页 *

Also Published As

Publication number Publication date
CN116360462A (en) 2023-06-30

Similar Documents

Publication Publication Date Title
CN112004742B (en) Underwater hull cleaner, hull cleaning system and method for cleaning ship hulls
AU2008350457B2 (en) Underwater cleaning robot and auxiliary cleaning work machine
CN109204723B (en) Automatic cleaning device and method for floating garbage in water area
CN106347594A (en) Wireless charging automatic water surface cleaning robot system
CN107168341A (en) The autonomous Synergistic method of the double unmanned boats of flexible connection formula surrounded and seize towards oil spilling
CN205308912U (en) Etting cleaning robot under water
JP2018158834A (en) Conveying device
CN105521975A (en) Underwater netting cleaning robot
CN116360462B (en) Obstacle avoidance method of netting cleaning robot
CN101868404A (en) Robotic phonton and automatic rubbish screening system, to clean up rubbishes floating into and out of waters zone
CN115366066B (en) Photovoltaic module cleaning robot and using method
WO2017124885A1 (en) Solar-powered aeration apparatus with intelligent navigation
KR20150053442A (en) Underwater cleaning robot
CN114019986B (en) Path planning method of wall-climbing robot
CN109317463A (en) A kind of underwater cleaning robot
WO2017146135A1 (en) Geological sample collecting method and work device allowing for orientation control
KR20150053373A (en) Underwater cleaning robot
CN111017056A (en) Cable channel intellectual detection system robot
JP7193817B2 (en) Weeding device for paddy fields, method for weeding paddy fields using the same, and method for producing cultivated crops
CN116674712A (en) Cabin cleaning and hull rust removing robot based on high-pressure water jet flight
CN109577295A (en) A kind of floater catch control method and device
CN212556729U (en) Underwater small target positioning and grabbing device
CN215514042U (en) Fishing boat
CN211543823U (en) Integrated device for cutting aquatic weeds and cleaning water surface garbage
CN112455665B (en) Paddy field balance take-off and landing unmanned aerial vehicle and fixed-point weeding recovery operation method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant