Slip rope type fishpond sludge disinfection robot and path planning method
Through the zipline-type donation device and path planning method, the problem of difficulty in moving underwater robots in complex geographical environments is solved, and efficient, convenient and low-cost drug loading of fish pond silt disinfection is achieved, which is suitable for automatic silt disinfection of fish ponds. .
Patent Information
- Application Number
- CN202411257142.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-09
- Publication Date
- 2024-12-06
AI Technical Summary
Existing underwater robots are difficult to move in complex geographical environments in fish ponds, especially in gullies and steep slopes. Traditional crawler robots are large in size and costly, and cannot frequently enter and exit the water for drug loading, which affects the health of fish fry.
A zipline fish pond silt disinfection robot is designed, using a donation device and a moving zipline to connect the main body, and non-contact movement is achieved through a roll and a support rod, which can move freely in all corners of the fish pond, and provides a path planning method to Achieve accurate movement and dressing changes of the subject.
The robot can move freely in a complex underwater environment, avoiding the difficulty of moving traditional robots in complex terrain, improving the convenience of drug loading and disinfection efficiency, and reducing labor costs.
Smart Images

Figure CN119077769A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of underwater robots, and in particular to a zipline-type fish pond sludge disinfection robot and a path planning method. Background Art
[0002] In the field of modern fish farming, the cleaning and maintenance of the underwater environment is crucial to ensure the healthy growth of fish. The accumulation of sludge in fish ponds not only affects the water quality, but also may become a breeding ground for pathogens. Therefore, regular sludge disinfection is an indispensable part of the farming process.
[0003] Underwater robots, also known as unmanned remote-controlled submersibles, are robots used for underwater operations. In order to ensure the normal growth and development of fish fry, the fish pond environment needs to be disinfected regularly. The traditional fish pond sludge disinfection mode generally uses the method of changing water to remove mud, but this method is inefficient, consumes a lot of manpower, and has a significant impact on the survival of fish fry.
[0004] There is no underwater robot specifically used for fish pond sludge disinfection, and the walking mechanisms of underwater robots are currently divided into crawler, wheeled and foot-type. Wheeled and foot-type underwater robots are difficult to cope with complex geographical environments such as underwater gullies and steep slopes, while crawler-type (such as the Chinese patent with publication number CN220242957U) walking assemblies have complex structures, large volumes and high costs, which are not suitable for small robots used for fish pond sludge disinfection. In addition, it is difficult to penetrate deep into the corners of the fish pond and it is not easy to frequently enter and exit the water for drug loading. Summary of the invention
[0005] In view of the deficiencies in the prior art, an object of an embodiment of the present invention is to provide a zipline-type fish pond sludge disinfection robot.
[0006] In order to achieve the above objectives, the embodiments of the present invention provide the following technical solutions:
[0007] A zipline-type fish pond sludge disinfection robot comprises: a main body, a moving zipline and a dispensing device, wherein the dispensing device is arranged at each corner of the fish pond, and each dispensing device is connected to the main body through a moving zipline; the dispensing device comprises a base, a wheel, a drum and a support rod, wherein the base is arranged on the ground beside the pond, and the base has a set distance from the shore, the wheel is rotatably mounted on the base in the horizontal direction, the drum is mounted on the wheel, the moving zipline is wound on the main shaft of the drum, and the support rod is mounted on the wheel and rotatably connected to the wheel in the vertical direction.
[0008] The embodiment of the present invention further provides a path planning method for the zipline type fish pond sludge disinfection robot as described above, comprising:
[0009] Get the length L of the motion cable from the initial position of the main body to the support rods of each dispensing device i and the length L of the moving cable from the main target position to the support rods of each dispensing device i ` ;
[0010] According to the length of the sports zipline L i And the length of the sports zipline L i ` Calculate the length change △L i ;
[0011] According to the length change △L i Calculate the speed n of each reel based on the time t i ;
[0012] The reels of each dispensing device rotate according to their respective rotation speeds, thereby moving the main body to a target position.
[0013] Optionally, obtain the pond side lengths a, b and the main body coordinates x, y;
[0014] According to the pond side length a, b and the main body coordinates x, y, the motion zipline pool bottom mapping l from the main body's initial position to the support rods of each allocation device and the motion zipline pool bottom mapping l from the main body's target position to the support rods of each allocation device are calculated. ` ;
[0015] Get the depth of the fish pond h, the distance s between the support pole and the shore, and the height p of the support pole;
[0016] Mapping l and l based on the bottom of the motion zipline pool ` The length of the moving cable L from the initial position of the main body to the support rods of each distribution device is calculated by the depth of the fish pond h, the distance of the support rod from the shore s, and the height of the support rod p i and the length L of the moving cable from the main target position to the support rods of each dispensing device i ` .
[0017] Optional, if △L i <0, the main axis of the reel is n i Reverse, converge the moving zipline, and at the same time drive the wheel on the base to rotate towards the target position;
[0018] If △L i >0, the main axis of the reel is n i Rotate forward, release the motion cable, and at the same time drive the wheel on the base to rotate towards the target position.
[0019] Optionally, it also includes the route planning for the main body to go ashore for dressing change:
[0020] Calculate the mapping \(l\) of the moving cable on the bottom of the pond from the current position of the main body to the support rods of each dispensing device according to the side lengths \(a\), \(b\) of the pond and the main body coordinates \(x\), \(y\).
[0021] Calculate the two-dimensional straight-line distance \(z\) on the bottom of the pond from the current position of the main body to each dressing change port according to the side lengths \(a\), \(b\) of the pond, the main body coordinates \(x\), \(y\) and the mapping \(l\) of the moving cable on the bottom of the pond.
[0022] Judge the magnitudes of the distances \(z\), and take the dressing change port corresponding to the minimum distance \(z\) as the target position of the dressing change location.
[0023] Calculate the rotational speeds of each reel according to the length change amount and time.
[0024] The reels of each dispensing device rotate according to their respective rotational speeds, thereby moving the main body to the dressing change location.
[0025] Optionally, if the vertical distance \(g\) from the target point of the main body to the shore satisfies the condition \(g < hs / p\), the support rods on the corresponding shore tilt forward synchronously at an angular velocity \(\omega\), where \(\omega=\arccos(s / p) / t\).
[0026] One or more technical solutions provided in the embodiments of the present invention have at least the following technical effects or advantages:
[0027] 1. The dispensing devices are installed at each corner of the fish pond and are connected to the main body through moving cables. By adopting the cable-based dispensing and moving method, the robot main body can frequently enter and exit the water for drug loading. The non-contact moving method is more suitable for dealing with complex geographical environments such as underwater gullies and steep slopes, enabling it to move freely in all corners of the fish pond, avoiding the problem of difficult movement of traditional tracked robots in complex terrains, and also eliminating the cumbersome walking mechanism.
[0028] 2. The base is fixed on the ground at the edge of the fish pond and is set at a certain distance from the shore to ensure stability. Moreover, when changing the dressing, the main body can be completely moved onto the shore, improving the convenience of dressing change, and at the same time preventing drugs from mixing into the water.
[0029] 3. The turntable is horizontally installed on the base and can rotate to support the main body to come ashore for dressing change or the main body to move along the shore in the fish pond, preventing the moving cable from detaching. The reel is installed on the turntable for winding the moving cable, and the support rod is installed on the turntable and is rotationally connected to the turntable in the vertical direction. Through the cooperation of the support rod and the turntable, even when the dispensing device is at a certain distance from the shore (ensuring that the main body can change the dressing on the shore), it can still work along the edge of the bottom of the pond in depth without affecting the breadth of the movement of the main body.
[0030] The advantages of the additional aspects of the present invention will be given in the following description, and some will become obvious from the following description, or will be understood through the practice of the present invention. Description of the Drawings
[0031] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the prior art, the drawings required for use in the embodiments or the prior art descriptions are briefly introduced below. Obviously, the drawings described below are only some embodiments recorded in the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work. In addition, the spacing or size between each other is exaggerated to show the position of each part, and the schematic diagram is only used for illustration.
[0032] Figure 1 is a schematic diagram of the arrangement of a donation device provided in an embodiment of the present invention;
[0033] Figure 2 is a schematic diagram of a dispensing device when the support rod is vertical provided by an embodiment of the present invention;
[0034] Figure 3 It is a schematic diagram of a dispensing device when a support rod is tilted forward provided by an embodiment of the present invention;
[0035] Figure 4 is a schematic diagram of system relationships provided by an embodiment of the present invention;
[0036] Figure 5 is a schematic diagram of a fusion terminal provided by an embodiment of the present invention;
[0037] Figure 6 is a two-dimensional coordinate diagram of the pool bottom provided by an embodiment of the present invention;
[0038] Figure 7 It is a schematic diagram of the arrangement of the donation device provided by the embodiment of the present invention on the shore;
[0039] Figure 8 is a schematic diagram of two-dimensional movement of the pool bottom provided by an embodiment of the present invention;
[0040] Fig. 9 This is a schematic diagram of determining the best dressing change point route provided by an embodiment of the present invention;
[0041] Fig.10 This is a schematic diagram of a target point near the shore provided by an embodiment of the present invention;
[0042] In the figure: 1. Almsgiving device; 11. Base; 12. Wheel; 13. Support rod; 14. Reel; 2. Moving zipline; 3. Main body; DETAILED DESCRIPTION
[0043] It should be noted that the following detailed descriptions are illustrative and are intended to provide further explanation of the present invention. Unless otherwise specified, all technical and scientific terms used in the present invention have the same meanings as those commonly understood by those of ordinary skill in the art to which the present invention belongs. In addition, it should also be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0044] As introduced in the background technology, most existing underwater robots use crawler, wheeled or foot-type walking mechanisms. These designs perform well on flat terrain, but are incapable of handling complex terrain such as gullies and steep slopes commonly seen in fish ponds. If the small robot used for fish pond sludge disinfection continues to use the traditional crawler walking mechanism, it cannot penetrate deep into the corners of the fish pond due to its large size, which requires manual secondary dredging and increases costs. Moreover, since it still uses the traditional landing walking movement mode, it cannot repeatedly and quickly complete the work of landing and launching for drug loading, resulting in low disinfection efficiency, increased labor costs, and failure to meet the design requirements of convenience.
[0045] In view of the shortcomings of the prior art, the present embodiment aims to provide a zipline-type fish pond sludge disinfection robot, which mainly improves its motion mechanism and path planning. The robot can adapt to complex underwater environments and integrates a variety of sensors to monitor the water quality, aquatic biological conditions and the precise position of the robot in real time, so as to realize automated and efficient sludge disinfection operations, reduce adverse effects on fish fry, and improve breeding efficiency.
[0046] like Figure 1 As shown, the zipline type fish pond sludge disinfection robot comprises a main body 3, a moving zipline 2 and a dispensing device 1, wherein the dispensing device 1 is arranged at each corner of the fish pond, and each dispensing device 1 is connected to the main body 3 via a moving zipline 2. Figure 2 , Figure 3 As shown, the donation device 1 includes a base 11, a wheel disc 12, a drum 14 and a support rod 13. The base 11 is set on the ground beside the pond, and the base 11 has a set distance from the shore. The wheel disc 12 is rotatably mounted on the base 11 in the horizontal direction, and the drum 14 is mounted on the wheel disc 12. The moving zipline 2 is wound around the main shaft of the drum 14. The support rod 13 is mounted on the wheel disc 12 and is rotatably connected to the wheel disc 12 in the vertical direction.
[0047] The dispensing device 1 is installed at each corner of the fish pond and connected to the main body 3 through a moving zipline 2. The zipline dispensing and movement method can enable the robot main body 3 to frequently enter and exit the water for drug loading. The non-contact movement method is more suitable for complex geographical environments such as underwater gullies and steep slopes, so that it can move freely in all corners of the fish pond, avoiding the problem of traditional crawler robots having difficulty moving in complex terrains, and also eliminating the cumbersome walking mechanism.
[0048] The base 11 is fixed on the ground at the edge of the fish pond, and the base 11 is set at a certain distance from the shore to ensure stability. When changing the medicine, the main body 3 can be completely moved to the shore, which improves the convenience of changing the medicine and prevents the medicine from mixing into the water.
[0049] The wheel disc 12 is horizontally mounted on the base 11 and can rotate to support the main body 3 to go ashore to change the dressing or the main body 3 to move along the shore in the fish pond to prevent the moving zip line 2 from detaching. The reel 14 is mounted on the wheel disc 12 and is used to wind the moving zip line 2. The support rod 13 is mounted on the wheel disc 12 and is connected to the wheel disc 12 in a vertical direction. Through the cooperation of the support rod 13 and the wheel disc 12, when the applicator 1 is at a certain distance from the shore (ensuring that the main body 3 can change the dressing on the shore), it can still work along the shore at the edge of the pond bottom without affecting the breadth of the movement of the main body 3.
[0050] The dispensing devices 1 have four, and the connecting lines of the four dispensing devices 1 form a rectangle. The four dispensing devices 1 are connected to the main body 3 through four moving zip lines 2, and the main body 3 is located within the range of the rectangle. This arrangement ensures that the moving range of the robot main body 3 covers the entire bottom of the fish pond, and the robot can be controlled to move freely in the entire rectangular area through the coordination of the four moving zip lines 2. The reasonable layout of the four dispensing devices 1 enables each dispensing device 1 to evenly distribute the tension of the zip line, avoiding the problem of excessive force on a single zip line or the robot being unable to move accurately. At the same time, the rectangular layout also provides higher stability, ensuring that the robot can be accurately positioned during the disinfection process, and that the zip line will not be entangled and affect the operation effect.
[0051] The support rod 13 and the reel 14 are both located on the upper side of the wheel disc 12, the reel 14 is located on the rear side of the support rod 13 away from the fish pond, and the rotation direction of the support rod 13 relative to the wheel disc 12 is perpendicular to the axis of the main shaft of the reel 14 (such as Figure 3 This structural design ensures the flexibility of the support rod 13 and avoids possible mechanical interference between the reel 14 and the support rod 13. With this configuration, when the wheel 12 rotates, the support rod 13 can drive the zip line to switch between different heights and angles, so that the robot can be more accurately positioned and moved at the bottom of the fish pond.
[0052] Furthermore, the robot also includes some electrical components and conventional equipment (such as Figure 4 , Figure 5 ), all obtained through outsourcing:
[0053] For example, power supply, fusion terminal, depth monitoring sensor, aquatic biological monitoring sensor, water quality monitoring sensor, intelligent switch, load equipment, positioning device, distribution device 1, control system and motion zipline 2, etc.
[0054] The depth monitoring sensor, aquatic biological monitoring sensor, water quality monitoring sensor, load equipment, and positioning device contained in the main body 3 are all integrated. The load equipment includes drug loading equipment, drug spraying equipment, and motion locking device. The sensor, load equipment, and positioning device together constitute the robot main body 3 parts.
[0055] The fusion terminal includes a power supply module, a load device control module, a depth sensor monitoring module, a water biological sensor monitoring module, a water quality sensor monitoring module, a control system access module, a positioning module, a communication port and a processor. The sensor monitoring module collects information from water quality monitoring sensors, water biological monitoring sensors and water quality monitoring sensors and transmits it to the processor. The positioning module collects feedback data from the positioning device and transmits it to the processor. The sensor monitoring module and the monitoring sensor transmit information through radio waves, infrared rays, Bluetooth, WiFi, Zigbee, etc.
[0056] The processor is connected to the power supply through the power supply module through the intelligent switch; the processor displays the received data on the display screen, and the display screen loads the control system and connects to the fusion terminal through the control system access module; the fusion terminal loads the local storage module and the cloud storage module. The cloud storage module communicates with the cloud storage terminal through 4G / 5G communication. The processor can use an embedded system or a microcomputer such as RaspberryPi, which is connected to the monitoring module through a serial port or USB interface to collect data and display it on the display screen.
[0057] The control system adopts SCC, and controls the dispensing device 1 through the communication port. The dispensing device 1 is connected to the ground through the base 11, and the main shaft of the reel 14 rotates through the support rod 13 to expand and contract the motion zip line 2 to control the movement of the main body 3; the base 11 is fixedly connected to the ground, and the support rod 13 can be driven to move by a mechanical gear. A motion locking device can also be added, and the motion locking device is locked with the main body 3. The motion zip line 2 is connected to the motion locking device and locked.
[0058] By equipping with depth monitoring sensors, aquatic biological monitoring sensors, water quality monitoring sensors and positioning devices, the water quality, farmed fish, location and depth of the fish pond can be monitored in real time, which can improve the farmer's understanding of the real-time status of the fish pond. Compared with traditional sludge disinfection methods, it can reduce the impact of sludge disinfection on fish to a certain extent. It has the advantages of simple operation, high efficiency and low manpower consumption.
[0059] The path planning method or main body movement control method of the above robot:
[0060] l i (i.e. l 1 , l 2 , l 3 , l 4 ) is the two-dimensional mapping length of the zipline from the main body to the position α, β, γ, δ on the bottom of the pond, such as Figure 6 As shown, when the subject is at (0, 0):
[0061] l 1 =0
[0062] l 2 =b
[0063] l 4 =a
[0064] l 3 =(a 2 +b 2 ) 1 / 2
[0065] When the subject moves x along the x-axis and y along the y-axis, when the subject is located at (x, y), the bottom mapping l of each motion zipline pool is:
[0066] l 1 =(x 2 +y 2 ) 1 / 2
[0067] l 2 =[(bx) 2 +y 2 ] 1 / 2
[0068] l 3 =[(bx) 2 +(ay) 2 ] 1 / 2
[0069] l 4 =[x 2 +(ay) 2 ] 1 / 2
[0070] like Figure 7 , and assume that the depth of the fish pond is h, the distance between the support rod and the shore is s, the height of the support rod is p, and L i (i.e. L 1 , L 2 , L 3 , L 4 ) is the actual length of the motion cable from the main body to the α, β, γ, δ support rods, and it is easy to get:
[0071] L i =[l i 2 +(h+p) 2 ] 1 / 2 +sL i / l i +s
[0072] It can be deduced that:
[0073] L i ={(l i +s)[l i 2 +(h+p) 2 ] 1 / 2} / l i
[0074] Right now:
[0075] L 1 ={(l 1 +s)[l 1 2 +(h+p) 2 ] 1 / 2} / l 1
[0076] L 2 ={(l 2 +s)[l 2 2 +(h+p) 2 ] 1 / 2} / l 2
[0077] L 3 ={(l 3 +s)[l 3 2 +(h+p) 2 ] 1 / 2} / l 3
[0078] L 4 ={(l 4 +s)[l 4 2 +(h+p) 2 ] 1 / 2} / l 4
[0079] ``
[0080] like Figure 8 As shown in the figure, if the main body is at (x, y) and needs to be moved to (x, y), it is easy to get the length L of the motion cable from each support rod to the main body before moving. i , after moving, the bottom map of each moving zip line pool is l ` and the length L of the motion cable from each support rod to the main body i ` , length change △L i , the radius of the reel spindle is r, and the action completion time t is:
[0081] L i ={(l i +s)[l i 2 +(h+p) 2 ] 1 / 2} / l i
[0082] L i ` ={(l i ` +s)[l i `2 +(h+p) 2 ] 1 / 2} / l i `
[0083] `
[0084] △L i =L i -L i
[0085] n i =△L i / 2πrt
[0086] Specifically:
[0087] l 1 ` =(x` 2 +y` 2 ) 1 / 2
[0088] l 2 ` =[(bx`) 2 +y` 2 ] 1 / 2
[0089] l 3` =[(b-x`) 2 +(a-y`) 2 ] 1 / 2
[0090] l 4 ` =[x` 2 +(a-y`) 2 ] 1 / 2
[0091] L 1 ={(l 1 +s)[l 1 2 +(h+p) 2 ] 1 / 2 } / l 1
[0092] L 2 ={(l 2 +s)[l 2 2 +(h+p) 2 ] 1 / 2 } / l 2
[0093] L 3 ={(l 3 +s)[l 3 2 +(h+p) 2 ] 1 / 2 } / l 3
[0094] L 4 ={(l 4 +s)[l 4 2 +(h+p) 2 ] 1 / 2 } / l 4
[0095] L 1 ` ={(l 1 ` +s)[l 1 `2 +(h+p) 2 ] 1 / 2 } / l 1 `
[0096] L 2 ` ={(l 2 ` +s)[l i`2 +(h+p) 2 ] 1 / 2} / it 2 `
[0097] IT 3 ` ={(l 3 ` +s)[l 3 `2 +(h+p) 2 ] 1 / 2} / it 3 `
[0098] IT 4 ` ={(l 4 ` +s)[l 4 `2 +(h+p) 2 ] 1 / 2} / it 4 `
[0099] `
[0100] △L 1 =L 1 -IT 1
[0101] `
[0102] △L 2 =L 2 -IT 2
[0103] `
[0104] △L 3 =L 3 -IT 3
[0105] `
[0106] △L 4 =L 4 -IT 4
[0107] n 1 =△L 1 / 2πrt
[0108] n 2 =△L 2 / 2πrt
[0109] n 3 =△L 3 / 2πrt
[0110] n 4 =△L 4 / 2πrt
[0111] If △L i <0, the main axis of the reel is n i Reverse, converge the motion zipline, and at the same time drive the wheel on the base to (x ` ,y ` ) direction; if △L i >0, the main axis of the reel is n i Rotate forward, release the motion cable, and drive the wheel on the base to (x ` ,y ` ) direction.
[0112] In this example, ∆L 1 <0, △L 2 >0, △L 3 >0, △L 4 <0, so the device α needs to be n 1 Reverse, converge the moving rope, and at the same time drive the applicator on the base to (x ` ,y ` ) direction of rotation; the donating device β needs to rotate in n 2 Rotate forward, release the moving slide rope, and at the same time drive the applicator on the base to (x ` ,y ` ) direction of rotation; the donating device γ needs to rotate in n 3 Rotate forward, release the moving slide rope, and at the same time drive the applicator on the base to (x ` ,y ` ) direction of rotation; the donating device δ needs to rotate in n 4 Reverse, converge the moving slide rope, and at the same time drive the applicator on the base to (x ` ,y ` ) direction; so that the subject moves from (x, y) to (x) within time t under the traction of the motion cable ` ,y ` ) at this point; at this point, the process of directional movement of the subject from any point to any point is completed.
[0113] like Fig. 9 As shown in the figure, A, B, C, and D are four dressing ports, located at the midpoint of each edge. z is the two-dimensional straight-line distance from the dressing port to the pond bottom when the subject is located at (x, y), where z 1 is the two-dimensional straight-line distance of the subject from A to the bottom of the pond, z 2 is the two-dimensional straight-line distance from the subject to the pond bottom B, z 3 is the two-dimensional straight-line distance of the subject from C to the bottom of the pond, z 4is the two-dimensional straight-line distance of the subject from the pond bottom to D, and it is easy to get:
[0114] z 1 ={x 2 +[(l 1 2 -x 2 ) 1 / 2 -a / 2] 2} 1 / 2
[0115] z 2 ={y 2 +[(l 2 2 -y 2 ) 1 / 2 -b / 2] 2} 1 / 2
[0116] z 3 ={(bx) 2 +[(l 2 2 -(bx) 2 ) 1 / 2 -a / 2] 2} 1 / 2
[0117] z 4 ={(ay) 2 +[(l 3 2 -(ay) 2 ) 1 / 2 -b / 2] 2} 1 / 2
[0118] The best dressing port is determined by comparing the size of z. min =z 1, Then select A as the dressing port; if z min =z 2, Then select B as the dressing port; if z min =z 3, Then select C as the dressing port; if z min =z 4, Then select D as the dressing change port; thus, the best dressing change port can be determined.
[0119] If the subject is at (x, y) and z min =z 1 , you need to enter A to change the dressing, L ` is the length of the motion cable from the support rod to the main body when the main body arrives at the dressing port A, the completion time is t, and the spindle speed of the dispensing device is n. At this time, it is easy to get:
[0120] L 1 ` =L 4 ` =[p 2 +(a / 2) 2 ] 1 / 2
[0121] L 2 ` =L 3 ` =[(a / 2) 2 +(b+2s) 2 +p 2 ] 1 / 2
[0122] The absolute value △L of the difference between the length of the motion zipline from the support rod to the main body when the main body arrives at the dressing port A and the length of the motion zipline from the support rod to the main body when the main body is located at (x, y) is:
[0123] △L i =|L i ` -L i |
[0124] Right now:
[0125] △L i / t=2πrn i
[0126] Specifically:
[0127] △L 1 / t=2πrn 1
[0128] △L 2 / t=2πrn 2
[0129] △L 3 / t=2πrn 3
[0130] △L 4 / t=2πrn 4
[0131] According to the above equation, the spindle speed n of the dispensing device is easily obtained as:
[0132] n i =△L i / 2πrt
[0133] Specifically:
[0134] n 1 =△L 1 / 2πrt
[0135] n 2 = ΔL 2 / 2πrt
[0136] n 3 = ΔL 3 / 2πrt
[0137] n 4 = ΔL 4 / 2πrt
[0138] Meanwhile, the adjacent two dispensing devices rotate inwards passively on the base towards the optimal dressing change opening, and within time t, the process of judging from any point and returning to the optimal dressing change opening is completed.
[0139] After the dressing change work is completed, the main shafts of each dispensing device reverse:
[0140] n i = ΔL i / 2πrt
[0141] Specifically:
[0142] n 1 = ΔL 1 / 2πrt
[0143] n 2 = ΔL 2 / 2πrt
[0144] n 3 = ΔL 3 / 2πrt
[0145] n 4 = ΔL 4 / 2πrt
[0146] Meanwhile, the adjacent two dispensing devices rotate outwards passively on the base towards the original direction, and within time t, the process of returning from the optimal dressing change opening to the original position is completed; thus, the main body completes a complete drug loading process.
[0147] In Fig.10 as shown, if the vertical distance g from the target point of the main body to one or several banks satisfies the condition: g < hs / p, the support rods on the corresponding banks tilt forward synchronously at an angular velocity ω to ensure that the main body can still enter the bottom along the bank of the fish pond on the premise that there is a certain safety distance between the dispensing device and the bank, where the angular velocity ω:
[0148] ω = arccos(s / p) / t
[0149] In Fig.10 the example shown: the distance g from the target point (x, y) to bank A a and gd If the condition g < hs / p is satisfied, then: the support rods on the dispensing devices α, γ, and δ tilt forward synchronously at ω = arccos(s / p) / t, so that on the premise that a certain safety distance is left between the dispensing devices and the shore, the main body can still enter the vicinity of the A shore and the D shore at the bottom of the fish pond for work.
[0150] Although the specific implementation manners of the present invention have been described above in conjunction with the accompanying drawings, it is not a limitation on the protection scope of the present invention. Those skilled in the art should understand that various modifications or deformations that can be made without creative efforts on the basis of the technical solution of the present invention are still within the protection scope of the present invention.
Claims
1. A zipline-type fish pond sludge disinfection robot, characterized in that: Comprising: A main body, a moving cableway, and a feeding device. The feeding devices are arranged at each corner of the fishpond, and each feeding device is connected to the main body through the moving cableway. The feeding device includes a base, a turntable, a reel, and a support rod. The base is arranged on the ground beside the pond, and there is a set distance between the base and the shore. The turntable is rotatably installed on the base in the horizontal direction. The reel is installed on the turntable. The moving cableway is wound around the main shaft of the reel. The support rod is installed on the turntable and is rotatably connected to the turntable in the vertical direction.
2. The zipline type fish pond sludge disinfection robot according to claim 1, characterized in that: There are four feeding devices. The connection lines of the four feeding devices form a rectangle. The four feeding devices are connected to the main body through four moving cableways, and the main body is located within the range of the rectangle.
3. The zipline type fish pond sludge disinfection robot according to claim 1, characterized in that: Both the support rod and the reel are located on the upper side of the turntable. The reel is located at the rear side of the support rod away from the fishpond. The rotation direction of the support rod relative to the turntable is perpendicular to the axis of the main shaft of the reel.
4. The zipline type fish pond sludge disinfection robot according to claim 1, characterized in that: The main body includes a sensor, a load device, and a positioning device. The load device includes a drug loading device and a drug spraying device.
5. The zipline type fish pond sludge disinfection robot according to claim 4, characterized in that: It further includes a fusion terminal. The fusion terminal includes a power supply module, a load device control module, a sensor monitoring module, a positioning module, and a processor. The processor is connected to the power supply through the power supply module. The sensor monitoring module collects the information of the sensor and transmits it to the processor.
6. A path planning method for a zipline fish pond sludge disinfection robot according to any one of claims 1 to 5, characterized in that: Comprising: Get the length L of the motion cable from the initial position of the main body to the support rod of each donation device i and the length L of the motion cable from the main target position to the support rods of each dispensing device i ` ; According to the length of the zipline L i And the length of the sports zipline L i ` Calculate the length change △L i ; According to the length change △L i Calculate the speed n of each drum using time t i ; The reels of each feeding device rotate according to their respective rotation speeds, so as to move the main body to the target position.
7. The path planning method according to claim 6, wherein: Obtain the side lengths a, b of the pond and the coordinates x, y of the main body. According to the pond side length a, b and the main body coordinates x, y, the motion zipline pool bottom mapping l from the main body's initial position to the support rods of each device and the motion zipline pool bottom mapping l from the main body's target position to the support rods of each device are calculated. ` ; Obtain the depth h of the fishpond, the distance s between the support rod and the shore edge, and the height p of the support rod. Mapping l and l based on the bottom of the motion zipline pool ` As well as the depth of the fish pond h, the distance s between the support rod and the shore, and the height p of the support rod, calculate the length L of the motion cable from the initial position of the main body to the support rod of each distribution device. i and the length L of the motion cable from the main target position to the support rods of each dispensing device i ` .
8. The path planning method according to claim 6, wherein: If △L i <0, the main axis of the reel is n i Reverse, converge the motion cable, and at the same time drive the wheel to rotate on the base towards the target position; If △L i >0, the main axis of the reel is n i Rotate forward, release the motion cable, and at the same time drive the wheel to rotate towards the target position on the base.
9. The path planning method according to claim 7, wherein: It further includes the path planning for the main body to come ashore for drug replacement: Calculate the mapping l of the moving cableway at the bottom of the pool from the current position of the main body to the support rods of each feeding device according to the side lengths a, b of the pond and the coordinates x, y of the main body. Calculate the two-dimensional straight-line distance z at the bottom of the pond from the current position of the main body to each drug replacement port according to the side lengths a, b of the pond, the coordinates x, y of the main body, and the mapping l of the moving cableway at the bottom of the pool. Judge the magnitudes of each distance z, and take the drug replacement port corresponding to the minimum distance z as the target position of the drug replacement location. Calculate the rotation speeds of each reel according to the change in length and time. The reels of each feeding device rotate according to their respective rotation speeds, so as to move the main body to the drug replacement location.
10. The path planning method according to claim 8 or 9, characterized in that: If the vertical distance g from the target point of the main body to the shore satisfies the condition g < hs / p, the support rod on the corresponding shore will tilt forward synchronously at an angular velocity ω, where ω = arccos(s / p) / t.
Citation Information
Patent Citations
Crawler-type underwater robot
CN220242957U
