Walking farmland mobile platform robot
Patent Information
- Application Number
- CN202111593381.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-12-23
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2041-12-23
AI Technical Summary
[0002]我国自古以来都是农业大国,勤劳的农民每年种植农作物都会尽可能的利用田地空间,如与田地相邻河滩地、田垄之间尽数种植农作物;在我国的农田里,密密麻麻的农作物是很常见的事情;同时,农民还对所种农作物怀有深厚的感情,不愿任何一株生长期的农作物受到损伤;这也有部分原因是我国基本国情决定的;大部分农民所耕种的土地没有连区成块,农民只能在划给自己的农田区域尽可能的种植农作物来提高收入;然而农作物生长并不是只需要埋下种子,等待收获即可完成;在农作物发芽成苗到生长成熟过程中,农民还是需要进行喷药、施肥、供水才能保证农作物幼苗茁壮生长直至结果收获;众多农作物里除少部分作物(如红薯、土豆)是在地下产出,大部分作物(如水稻、小麦、棉花)是在地上产出;一方面地上产出的作物需要喷药、施肥、供水,另一方面农民密集种植,这就要求农用机械在喷药、施肥、供水过程中应尽量避免对农作物造成损伤;然而现有的农用机械多是轮式行进,在农作物的生长期进入农田喷药、施肥,存在通过率差、损苗率高的问题;尤其是对棉花、油菜等这种横向产出的作物,农用机械的倾轧所造成的破坏更是严重;现有技术并没有行动灵活,并能减少对作物倾轧的移动设备
[0012] The beneficial effects of the present invention are: the walking farmland mobile platform robot of the present invention includes a central mobile platform, alternating progressive mechanism armor symmetrically arranged on the left and right sides of the mobile platform, and a rotation drive connected to the end of the alternating progressive mechanism armor. device, an outrigger connected to the output end of the rotational drive device, and a wheel with brakes fixedly connected to the lower end of the outrigger; the alternating progressive mechanism armor acting alone determines the walking stride; the alternating progressive mechanism armor and the rotational drive device cooperate action; alternation The instantaneous horizontal speed of the progressive mechanism's traversing wheel is equal to the horizontal component of the instantaneous linear speed of the rotating drive device's deflected wheel, but in opposite directions; the resultant speed of the wheel is only the vertical lifting speed; the two processes are carried out alternately, and the wheel can Ensure appropriate stride length and vertical entry and exit of farmland; each wheel is divided into two groups to alternately cooperate with each other; when one set of wheels is used as a support, the other set of wheels walks, achieving the purpose of the mobile platform moving into the farmland flexibly without overturning the crops.
Smart Images

Figure CN114275070B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of agricultural machinery, and in particular to a walking farmland mobile platform robot. Background Art
[0002] my country has been a major agricultural country since ancient times. Hardworking farmers will make full use of the field space to grow crops every year, such as planting crops in the riverbeds adjacent to the fields and between the ridges. It is common to see densely packed crops in my country's farmlands. At the same time, farmers also have deep feelings for the crops they grow and do not want any crop in the growing season to be damaged. This is also partly due to my country's basic national conditions. Most of the land cultivated by farmers is not contiguous, so farmers can only plant as many crops as possible in the farmland areas allocated to them to increase their income. However, crop growth is not just about burying seeds and waiting for harvest. In the process of crop germination and seedling growth to maturity, farmers still need to spray pesticides, apply fertilizers, and supply water. It can ensure that the seedlings of crops grow vigorously until they are harvested; among the many crops, except for a small number of crops (such as sweet potatoes and potatoes) that are produced underground, most crops (such as rice, wheat, and cotton) are produced above ground; on the one hand, crops produced above ground need to be sprayed, fertilized, and watered, and on the other hand, farmers plant them intensively, which requires that agricultural machinery should try to avoid damaging crops during the spraying, fertilizing, and watering process; however, most existing agricultural machinery is wheeled, and enters the farmland to spray and fertilize during the growth period of crops, which has the problems of poor pass rate and high seedling damage rate; especially for horizontally produced crops such as cotton and rapeseed, the damage caused by the crushing of agricultural machinery is even more serious; the existing technology does not have mobile equipment that is flexible and can reduce the crushing of crops. Summary of the invention
[0003] The purpose of the present invention is to solve the above problems and provide a walking farmland mobile platform robot.
[0004] The technical solution of the present invention is: a walking type farmland mobile platform robot, including a central mobile platform, an alternating progressive mechanism A symmetrically arranged on the left and right sides of the mobile platform, a rotating drive device connected to the end of the alternating progressive mechanism A, a support leg connected to the output end of the rotating drive device, and a wheel with a brake fixed to the lower end of the support leg; the alternating progressive mechanism A and the rotating drive device can cooperate with each other so that the instantaneous horizontal velocity of the transverse wheel of the alternating progressive mechanism A and the horizontal component velocity of the instantaneous linear velocity of the deflection wheel of the rotating drive device are equal in magnitude and opposite in direction.
[0005] Preferably, the alternating progressive mechanism A on each side includes a gear motor fixedly connected to the mobile platform, a gear connected to the output end of the gear motor, and two movable racks meshing with the gears; the movable racks have the same orientation; and the ends of the movable racks are connected to the rotating drive device.
[0006] Preferably, the mobile platform is provided with a plurality of clamping gear rollers; the clamping gear rollers are divided into two groups, upper and lower, and are arranged along the longitudinal array of the mobile rack to clamp the mobile rack from the upper and lower directions.
[0007] Preferably, a vertical toothed plate is provided on the mobile platform; the toothed plate separates two mobile racks meshing with the same gear.
[0008] Preferably, the lower end of the leg is connected to the wheel via a shock absorber.
[0009] Preferably, a control box is provided under the mobile platform.
[0010] Preferably, the output end of the rotary drive device is connected to a downward telescopic drive device; the telescopic drive device comprises a push rod sleeve fixedly connected to the output end of the rotary drive device, and a push rod sleeved in the push rod sleeve; the end of the push rod is connected to a wheel.
[0011] Preferably, the mobile platform has an alternating progressive mechanism B that is symmetrically arranged front to back; the end of the alternating progressive mechanism B is connected to a rotation drive device; the output end of the rotation drive device is connected to a downward telescopic drive device.
[0012] The beneficial effects of the present invention are as follows: the walking farmland mobile platform robot of the present invention comprises a central mobile platform, an alternating progressive mechanism A symmetrically arranged on the left and right sides of the mobile platform, a rotating drive device connected to the ends of the alternating progressive mechanism A, a support leg connected to the output end of the rotating drive device, and a wheel with a brake fixed to the lower end of the support leg; the alternating progressive mechanism A acting alone determines the walking stride; the alternating progressive mechanism A and the rotating drive device cooperate in action; the instantaneous horizontal velocity of the transverse wheel of the alternating progressive mechanism A is equal to the horizontal component velocity of the instantaneous linear velocity of the deflected wheel of the rotating drive device, but in opposite directions; the combined velocity of the wheels is only the vertical lifting velocity; the two processes are performed alternately, so that the wheels can ensure a suitable stride and vertical entry and exit of the farmland; each wheel is divided into two groups and cooperates with each other alternately; when one group of wheels is used as a support, the other group of wheels walks, so as to achieve the purpose of the mobile platform flexibly entering the farmland without crushing crops. BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Figure 1 is a three-dimensional diagram of the first embodiment of the present invention;
[0014] Figure 2 yes Figure 1 A side partial cross-sectional view of
[0015] Figure 3 yes Figure 2 AA section view;
[0016] Figure 4 It is a schematic diagram of the principle of turning in the first embodiment;
[0017] Figure 5 is a stereogram of a second embodiment of the present invention;
[0018] Figure 6 yes Figure 5 Side view of
[0019] Figure 7 yes Figure 6 BB cross-sectional view;
[0020] Figure 8 yes Figure 6 CC section view;
[0021] Fig. 9 is a block diagram of the passive navigation method adopted in Embodiment 3;
[0022] Fig.10 This is an overall schematic diagram of the working state of the third embodiment;
[0023] Fig.11 is a detailed schematic diagram of the working state of the third embodiment;
[0024] Fig.10 In the figure, the solid line represents the boundary of the field, the dotted line represents the ideal walking route automatically planned by the system based on the field, and the small square represents the robot; Figure 3 In the figure, the circle of N represents the radio reference point, the realization represents the actual walking route, the dotted ring line represents the ideal walking route, and the solid origin represents the actual landing point of each step.
[0025] In the figure: 1. mobile platform, 11. clamping roller, 12. tooth plate, 13. control box, 21. gear motor, 22. gear, 23. mobile rack, 3. rotation drive device, 4. support leg, 5. wheel, 51. brake, 61. push rod, 62. push rod sleeve, 7. shock absorber, 71. spring, 72. shock absorber rod, 73. shock absorber sleeve, 8. alternating progressive mechanism B. DETAILED DESCRIPTION
[0026] Example 1: See Figure 1-3A walking farmland mobile platform robot comprises a central mobile platform, an alternating progressive mechanism A symmetrically arranged on the left and right sides of the mobile platform, a rotating drive device connected to the end of the alternating progressive mechanism A, a leg connected to the output end of the rotating drive device, and a wheel with a brake fixed to the lower end of the leg; the mobile platform is used to hold materials; the alternating progressive mechanism A is used to drive the legs to alternately support the ground for moving; the rotating drive device is used to drive the legs to rotate; the wheels directly form support with the ground; the alternating progressive mechanism A and the rotating drive device can cooperate with each other to make the alternating progressive mechanism A and the rotating drive device The instantaneous horizontal velocity of the transverse wheel of the alternating progressive mechanism A is equal to the horizontal component of the instantaneous linear velocity of the deflection wheel of the rotating drive device, but in opposite directions; the reference points of the instantaneous horizontal velocity of the transverse wheel of the alternating progressive mechanism A and the instantaneous linear velocity of the deflection wheel of the rotating drive device are both the ground; the forward extended alternating progressive mechanism A makes the combined motion of the wheels a vertical lifting motion, and the wheels form support with the ground in the form of being embedded; while the alternating progressive mechanism A acts alone, that is, the rotating drive device does not act, which determines the stride of the walking farmland mobile platform robot in one step.
[0027] The alternating progressive mechanism A on each side includes a gear motor fixedly connected to the mobile platform, a gear connected to the output end of the gear motor, and two moving racks meshing with the gears; the moving racks are oriented in the same direction; the ends of the moving racks are connected to a rotating drive device; the two racks move forward alternately to complete the advancement of the entire mobile platform.
[0028] The mobile platform is provided with a number of clamping rollers; the clamping rollers are divided into two groups, both arranged along the longitudinal direction of the mobile rack, clamping the mobile rack from the upper and lower directions to ensure that the two mobile racks move forward alternately in the horizontal direction, while reducing the friction of the mobile rack.
[0029] A vertical toothed plate is provided on the mobile platform; the toothed plate separates two mobile racks meshing with the same gear so that the movements of the two mobile racks do not interfere with each other.
[0030] The lower end of the leg is connected to the wheel through a shock absorber, which is used to alleviate the impact on the mobile platform when the wheel forms a support with the ground; the shock absorber selected in this embodiment is a spring shock absorber; the spring shock absorber includes a shock absorber rod, a shock absorber sleeve and a spring; the upper end of the shock absorber sleeve is connected to the lower end of the leg, and the lower end is mounted outside the shock absorber rod and slides with the upper end of the shock absorber rod; the lower end of the shock absorber rod is connected to the wheel; the spring is mounted outside the shock absorber rod and the shock absorber sleeve, and its two ends are respectively connected to the lower end of the leg and the wheel; the spring shock absorber mainly relies on the compression of the spring to absorb the impact and shock absorption brought by the ground, and the sliding cooperation of the shock absorber rod and the shock absorber sleeve provides a guide for the compression and release of the spring.
[0031] The use of a steering gear as the rotation driving device in the first embodiment is only a specific application example; other devices capable of driving the rotation can be adaptively replaced;
[0032] A control box is provided under the mobile platform to control the movement of the robot.
[0033] Working process of embodiment 1:
[0034] When the robot moves, the gear motors on both sides rotate synchronously at the same speed, driving the two moving racks, one moving forward and the other moving backward;
[0035] During the robot's movement, the wheel brakes are all locked; taking a single wheel as an example, when the end of the moving rack connected to the wheel reaches a suitable position, the rotation drive device starts to work and rotates the legs to deflect the wheel from front to bottom (see Figure 2 ), the end of the moving rack changes speed and extends forward; the instantaneous speed of the moving rack changing speed and extending forward is equal to the instantaneous horizontal component speed of the wheel deflecting downward, and the direction is opposite, so that the combined movement of the wheel can only be inserted vertically into the ground; when the wheel contacts the ground, the shock absorber can buffer the impact of the ground on the wheel to ensure the stability of the mobile platform, and the wheel will not rotate to form a stable ground support; when the wheel is about to break contact with the ground, the gear motor changes speed and rotates in the reverse direction, the rotation drive device also rotates in the reverse direction, the moving rack changes speed and retreats, and the wheel deflects forward; the instantaneous speed of the moving rack changing speed and retreating is equal to the instantaneous horizontal component speed when the wheel deflects forward, and the direction is opposite, so that the combined movement of the wheel can only be vertically away from the ground;
[0036] The wheels on the robot are grouped into four, and the wheels in the group work synchronously. The wheels between groups alternately support the ground to form a walking effect. Each wheel moves vertically when it touches the ground or moves away from the ground, that is, in the form of insertion, which has less impact on crops.
[0037] Robot turns, see Figure 4 , take the robot turning left as an example. When the robot wants to turn left, the left wheel of the same group moves backward relative to the right wheel at the landing position; then the brakes on each wheel are controlled to lock the front wheel and let the rear wheel rotate freely; then, the gear motor on the left drives the left end of the mobile platform away from the front wheel on the left side that is standing firmly, such as Figure 4 As shown by the arrow on the left side of the figure; the gear motor on the right side drives the right end of the mobile platform to approach the right front wheel that stands firmly, as shown in FIG. Figure 4 As shown by the arrow on the right side of ; the mobile platform is equivalent to bearing Figure 4 The counterclockwise torque shown in the middle of the figure; in this way, the front end of the mobile platform tilts to the left, the front wheels will slide and rub against the ground to get closer, and the rear wheels will roll and rub as the mobile platform tilts, so that the robot can turn left; the robot can turn right by referring to the corresponding operations for turning left.
[0038] Example 2, see Figure 5-8The scheme of the second embodiment is basically the same as that of the first embodiment, and the similarities are not repeated here. The difference lies in that: the output end of the rotation drive device is connected to a downward telescopic drive device; the telescopic drive device includes a push rod sleeve fixedly connected to the output end of the rotation drive device, and a push rod sleeved in the push rod sleeve; the end of the push rod is connected to a wheel to replace the support leg in the first embodiment, which can speed up the speed of the wheel entering and exiting the field, reduce the stroke of the alternating progressive mechanism A, and make the robot structure more compact.
[0039] An alternating progressive mechanism B is symmetrically arranged on the front and rear sides of the mobile platform; the end of the alternating progressive mechanism B is connected to a rotating drive device; the output end of the rotating drive device is connected to a downward telescopic drive device; the alternating progressive mechanism B works when the robot needs to turn, and performs a lateral movement perpendicular to the robot's moving direction to replace the robot's turning action.
[0040] Embodiment 3: Based on Embodiment 1 or Embodiment 2, the walking farmland mobile platform robot adopts a passive navigation method to operate; see Figure 9-11 The implementation of the method includes setting a radio reference point at a certain position of the farmland, two direction sensors located on the farmland mobile platform robot, a radio communication module communicating with the radio reference point, a calculation module, and a storage module. The method includes the following steps:
[0041] ① First, the farmland to be operated is surveyed and mapped, a digital map of the farmland is drawn, and the map is stored in the storage module on the farmland mobile platform robot;
[0042] ② The computing module plans the ideal walking route of the walking farmland mobile platform robot in the farmland according to the digital map of the farmland;
[0043] ③ According to the digital map of the farmland, a radio reference point N is fixed at the edge or a corner of the farmland, and the position data of the position in the actual farmland is measured on site, and the position data is stored in the storage module of the walking farmland mobile platform robot; at the same time, the starting position of the route is determined in the farmland according to the ideal walking route in step ②;
[0044] ④ According to the ideal walking route planned in step ②, the walking farmland mobile platform robot is transferred to the starting position in the actual farmland, the walking direction angle of the ideal walking route is determined as θ0, and the actual walking direction of the robot in the first step is defined as θ1, the actual walking direction of the second step is θ2, and the actual walking direction of the nth step is θ n ,θ n is the angle between the walking direction and the reference direction, θ0 is the angle between the ideal walking route and the reference direction, and the reference direction is the south direction or the north direction;
[0045] ⑤Use the isometric deviation accumulation method to control the robot's walking route, which specifically includes the following sub-steps;
[0046] 5.1. At the starting point of the operation, in step 1, the robot measures the direction value θ1 according to the direction sensor, and plans the direction of the walking route to be θ0. The control calculation center calculates the direction deviation value α1, where α1 is the deflection angle between θ1 and θ0, θ0-θ1=α1. At this time, the cumulative direction deviation is β=α1, and the robot is driven to adjust the walking direction so that β approaches zero, and the robot takes the first step.
[0047] 5.2, Step 2, the robot direction sensor measures the direction value as θ2, and the direction deviation angle is θ0-θ2=α2. At this time, the cumulative direction deviation is β=α1+α2, and the robot is driven to adjust the walking direction so that β approaches zero and walks the second step;
[0048] …
[0049] 5.n, step n, the robot direction sensor measures the direction value as θ n , the direction angle is θ0-θ n =α n , at this time the cumulative direction deviation is β = α1 + α2 + ... + α n , and drives the robot to adjust the walking direction so that β approaches zero and walks the nth step.
[0050] The digital map of the farmland in step ① includes the length and direction of each side of the farmland, and the shape and location of internal obstacles.
[0051] Embodiment 4: Embodiment 4 is basically the same as Embodiment 3, and the similarities are not repeated. The difference is that Embodiment 4 adds the following steps on the basis of Embodiment 3. In step ⑤, with each step, the wireless communication module on the robot is used to monitor the distance between the machine and the radio reference point, and then compare it with the theoretical distance in the theoretical walking route. If the distance difference δ is within a reasonable range, the robot can continue to walk normally, otherwise the robot adjusts to move in a direction perpendicular to the theoretical direction to return the robot to the ideal walking route.
[0052] The row distance of the ideal walking route is Z, and the component δ of the distance difference δ in the direction perpendicular to the theoretical walking direction is - , δ - ≤Z / 10, the robot continues to walk normally, otherwise the robot adjusts and moves in a direction perpendicular to the theoretical directionδ - , so that the robot returns to the ideal walking route.
[0053] The methods in embodiments three and four of the present invention are mainly applicable to embodiments one and two of this patent application, as well as patent number 202021146185.4, named navigation of walking farmland mobile platform robot walking in farmland. The robot in this patent adopts a human-like stepping method, and the distance of each step is equal, so that the operation of the above method can be realized. Of course, it can also be applied to other devices with equal strides. This method is not applicable to wheeled devices because there is no stride method.
Claims
1. A walking farmland mobile platform robot, comprising a central mobile platform, an alternating progressive mechanism A symmetrically arranged on the left and right sides of the mobile platform, a rotation drive device connected to the end of the alternating progressive mechanism A, and a leg connected to the output end of the rotation drive device, characterized in that: A wheel with a brake is fixedly connected to the lower end of the outrigger; the alternating progressive mechanism A and the rotating drive device can cooperate with each other so that the horizontal component of the instantaneous horizontal velocity of the transverse wheel of the alternating progressive mechanism A and the instantaneous linear velocity of the deflected wheel of the rotating drive device are equal in magnitude and opposite in direction; the lower end of the outrigger is connected to the wheel through a shock absorber.
2. The walking farmland mobile platform robot according to claim 1, characterized in that: Each side alternating progressive mechanism A includes a gear motor fixedly connected to the mobile platform, a gear connected to the output end of the gear motor, and two moving racks meshing with the gears; the moving racks have the same orientation; and the ends of the moving racks are connected to the rotation drive device.
3. The walking farmland mobile platform robot according to claim 2, characterized in that: The mobile platform is provided with a plurality of clamping gear rollers; the clamping gear rollers are divided into two groups, upper and lower, and are arranged along the longitudinal array of the mobile rack to clamp the mobile rack from the upper and lower directions.
4. The walking farmland mobile platform robot according to any one of claims 2-3, characterized in that: A vertical toothed plate is provided on the mobile platform; the toothed plate separates two mobile racks meshing with the same gear.
5. The walking farmland mobile platform robot according to claim 1, characterized in that: A control box is provided under the mobile platform.
6. The walking farmland mobile platform robot according to claim 1, characterized in that: The output end of the rotating drive device is connected with a downward telescopic drive device; the telescopic drive device comprises a push rod sleeve fixedly connected to the output end of the rotating drive device, and a push rod sleeved in the push rod sleeve; the end of the push rod is connected with a wheel.
7. The walking farmland mobile platform robot according to claim 6, characterized in that: An alternating progressive mechanism B is symmetrically arranged on the front and rear sides of the mobile platform; the end of the alternating progressive mechanism B is connected with a rotating drive device; the output end of the rotating drive device is connected with a downward telescopic drive device.
