PRUNING ROBOT FOR REMOVING PROCESSIONARY CATERPILLAR NESTS
20220174932 · 2022-06-09
Inventors
Cpc classification
B64U2101/00
PERFORMING OPERATIONS; TRANSPORTING
B64U2101/40
PERFORMING OPERATIONS; TRANSPORTING
B64C39/024
PERFORMING OPERATIONS; TRANSPORTING
International classification
A01G3/08
HUMAN NECESSITIES
B25J11/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
Pruning robot including means for removing processionary caterpillar nests, the robot being characterized in that it is carried by a drone provided with an onboard automaton, which is equipped with an electromechanical tool consisting of a gripper associated with a cutting device intended to cut the branches supporting the nests that are to be removed.
Claims
1-10. (canceled)
11. A weeding robot comprising: a flying drone, the flying drone comprising an on-board automaton; means for eliminating nests of pine processionary caterpillars, an articulated gripper arranged to grip the flying drone with a branch supporting a nest to be eliminated, a cutting device mounted on the flying drone, the cutting device being intended to cut a branch supporting a nest to be eliminated.
12. A weeding robot according to claim 11, comprising a drone's inertia control unit and wherein the on-board automaton is equipped with a horizontal support pole carrying the cutting device, and wherein centering of said weeding robot is adjusted by the drone's inertia control unit aided by a counterweight including the battery for powering the robot.
13. A weeding robot according to claim 12, wherein the articulated gripper comprises a motorized articulated gripper which moves along the horizontal support pole under an action of a first linear actuator controlled by a microprocessor of the on-board automaton, a second linear actuator being arranged to synchronously move said counterweight along the horizontal support pole, to adjust centering of the weeding robot during the movements of the articulated gripper.
14. A weeding robot according to claim 12, wherein the cutting device comprises a circular saw rotated by a first electric motor, said circular saw being provided with a rotating cutting disc projecting forwardly with respect to the first motor.
15. The robot weeding machine according to claim 14, wherein the articulated gripper gripper is arranged under the cutting device, said articulated gripper being actuated by a second electric motor driving two jaws of the motorized articulated gripper between a closed position and an open position.
16. A weeding robot according to claim 15, wherein the second motor of the articulated gripper comprises a transmission system cooperating with two links intended to move the two jaws towards and away from each other, respectively in a closed position and in an open position.
17. A weeding robot according to claim 15, wherein the articulated gripper is supported by a first cylindrical tube intended to slide in a second tube of a frame to guide forwards or backwards of the articulated gripper under an action of a control mechanism of the first actuator, said frame being mounted so that it can pivot about an axis of the pole on a ball bearing.
18. A weeding robot according to claim 17, wherein the control mechanism of the first linear actuator comprises a switch provided with a bumper cooperating with a pusher coming into engagement with a connector for starting the on-board automaton and closing the articulated gripper as soon as the bumper strikes the branch supporting the nest.
19. A weeding robot according to claim 15, wherein the on-board automaton is controlled by an electronic box containing a microprocessor intended to control the first and second motors as well as the first and second actuators.
20. Automatic method for locating and destroying a nest of pine processionary caterpillars on an infested tree, using a weeding robot according to claim 11, comprising the following successive steps: locating by an operator on an infested tree a nest of caterpillars to be removed, choosing a vertical plane of approach by the operator, placing the weeding robot on a mat placed in front of the infested tree, and orient the weeding robot in the vertical plane of approach heading of the nest by the operator, the weeding robot being fixed to a flying drone, launching from a tablet a standard pre-programmed mission for the flying drone after powering up various components of the weeding robot by an operator, monitoring by an operator on a screen of the tablet images of a front camera of the flying drone, information on a progress of the standard pre-programmed mission, automatically executing the standard mission pre-programmed in a navigation software of the flying drone, using data from sensors of the flying drone and the front camera, with display on the tablet, detecting with the front camera a white spot representative of the nest, save an altitude of the nest and designate the nest as a target to reach advancing the flying drone horizontally towards the target until a bumper of a mechanical contactor of the flying drone comes against a branch supporting the nest, which pauses its navigation mission and activates a weeding automaton: executing a program of a processor of the weeding automaton, closing an articulated gripper to grip and tighten the branch, followed by starting a circular saw of the flying drone to cut the branch, causing the nest to fall, and disappearance of the nest from a field of vision of the front camera and from the screen of the tablet, resuming the navigation mission so as to land the flying drone.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0028] Other advantages and characteristics will become clearer in the following description of particular modes of realization and implementation of the invention given as non-limiting examples and represented in the attached drawings, in which :
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
[0046]
[0047]
[0048]
[0049]
[0050]
[0051]
[0052]
[0053]
[0054]
DESCRIPTION OF THE OPERATING METHODS
[0055] According to
[0056] At least four rotors (quadcopter)
[0057] Can lift up to several tens of meters, a total mass of the order of a kilogram, while remaining perfectly controllable
[0058] Richness in optical, ultrasonic and/or laser sensors (LIDAR)
[0059] Frontal camera with display on a touch pad.
[0060] Stable hovering flight possible in autopilot mode
[0061] Modular standard control software with several “intelligent” flight modes, including the execution of pre-programmed missions, and the tracking of a designated target.
[0062] Selective obstacle detection, with distance measurement
[0063] SDK (System Development Kit) available to add functions to its standard software and/or otherwise process sensor measurements to modify in flight navigation parameters, for example.
[0064] Several suppliers, under French or international trade marks, manufacture and sell drones meeting these specifications.
[0065] According to
[0066] According to
[0067] According to
[0068] Returning to
[0069] When the drone 27 has found the white spot, thus the nest 31, it is in position 29e, at the altitude of the nest. It defines in its collimator the target to be reached: a small brown stem, a few centimeters below the base of the white spot. The drone 27 then advances horizontally towards this target while remaining on the starting heading 25, and passes successively through positions 29e, 29f, 29g, All the necessary trajectory corrections are made without manual intervention by the drone navigation software, without any pivoting, with automatic commands of very low amplitude: Left, Right, Up and Down only. At about 1 meter from the target, in position 29g, the drone 27 slows down, refines its aiming, and continues its progression at very low speed until the bumper of the contactor of the weeding automaton strikes the branch supporting the nest 31. The rest of the process is described from the description of
[0070] The following
[0071] According to
[0072] The lower portion of the frame 39, below the face 48c is the tubular bracket 41. The top portion of the tubular bracket 41 has a cylindrical hole 54, in which the first cylindrical tube 63, supporting the gripper 61, can slide parallel to the plate 48e and rotate. At the rear and in line with the cylindrical hole 54, the first cup 58 accommodates the ball bearing 60. On each side of the front of the tubular bracket 41, the two bosses 57 are the attachment points for the two springs 71, which connect the frame 39 to the pole 32.
[0073] The lower part of the tubular bracket 41 is a double housing 55 where the body of the second linear actuator 69 is embedded, held in position by two small locking screws tightened in the two tapped holes 56.
[0074] According to
[0075] According to
[0076] According to
[0077] According to
[0078] According to
[0079] According to
[0080] According to
[0081] In this embodiment of the invention, the weeding automaton 34, is carried by an existing drone 27, whose motorization and autopilot cannot immediately balance any centering imbalance of the robot 29 induced by the movement of the gripper 61 relative to the cutting disc 43 of the circular saw 40, the preferred cutting tool. The adjustable counterweight 38 is then required. A first linear actuator 89, is programmed to slide the craddle 91 in synchronism with the displacement of the gripper 61, and thus maintain the centering of the robot 29 within limits compatible with the autopilot of the drone 27. The body of the first actuator 89 is held by two brackets 101a and 101b in a fixed position under the front of the tube 100 of the craddle 91. The front bracket 101a is integral with the craddle 91. The rear bracket 101b slides along the tube 100 during the assembly of the actuator 89, then is blocked by 2 tightening screws on both sides of the tube 100. A bolt 105b immobilizes the actuator 89 under the nacelle 91 in the bracket 101b. The end of the piston 90 of the first actuator 89 is connected by a bolt 105a to a stop 53 locked after adjustment on the pole 32 by a bolt 104.
[0082] According to
[0083] According to
[0084] According to
[0085] According to
[0086] According to
[0087] The piston 70 of the second linear actuator 69 moves forward, pushing the second motor 66 of the gripper 61, which returns to its starting position with the jaws 62 open. The drone 27 moves back to the vertical of its home base 24, then descends and lands, its mission completed.
[0088] According to
[0089] According to
Detailed Operating Mode
MO-1 Preparation
[0090] A single person, man or woman, conducts the whole operation. This person will be referred to in this procedure as the “operator”. He/she does not need to be qualified as a drone pilot.
[0091] The operator:
[0092] Checks for wind.
[0093] Visually locate the pine processionary caterpillar nest to be destroyed.
[0094] Choose a vertical plane of approach, free of any obstacle.
[0095] Prepares the drone, and if not included, mounts the weeding automaton on the drone.
[0096] Position on the ground a takeoff mat for the drone,
[0097] at about 2 meters from the vertical cylinder, envelope of the tree where the nest is.
[0098] The center of the mat is in the plane of approach.
[0099] The vertical bars of the H of the mat are parallel to this plane.
[0100] Position in the center of the mat, the drone carrying its onboard automaton.
[0101] The front of the drone is oriented towards the nest, which determines its departure heading «nestHeading » maintained permanently during the whole flight.
MO-2 Start-Up of all the Devices
[0102] The operator:
[0103] Turns on the drone control console.
[0104] Turns on the tablet associated with this console.
[0105] Launches the drone control application on this tablet.
[0106] Turns on this drone.
[0107] Checks all the parameters on the console and on the tablet : OK? [0108] Yes: he continues the procedure; [0109] No : he abandons the procedure. [0110] Turns on the automaton on-board the drone. [0111] Activates manually the on-board automaton by pressing its bumper.
[0112] The on-board automaton :
[0113] Executes “blank”, on the ground, a cycle of the automatism (the whole sequence) [0114] Closes the gripper. [0115] Starts the circular saw motor. [0116] Recoil of the closed gripper +advance of the centering counterweight. [0117] Stop of the circular saw motor. [0118] Gripper opening. [0119] Advance of the open gripper. [0120] Recoil of the counterweight
[0121] he components of the weeding automaton have returned to their starting position.
[0122] The LED on the on-board automaton is green: [0123] Yes : the on-board automaton is working correctly, continue. [0124] No: the on-board automaton is faulty, abandon the procedure.
[0125] The on-board automaton is operational. It is active and waits for a pressure on its bumper to execute a new cycle.
MO-3 Launching the Mission
[0126] The operator:
[0127] Presses button 110 (automatic mode) on tablet 23.
[0128] He becomes a simple observer, who will not intervene until the end of the mission.
[0129] The drone: [0130] Takes off in normal mode. [0131] Goes up 2 meters vertically, above the H of mat 17. [0132] Stops in hover and switches to “intelligent” stabilized mode. [0133] Activates only frontal obstacle detection. [0134] Enables obstacle detection and avoidance in other directions. [0135] Enables automatic target acquisition mode.
MO-4 Target acquisition and designation
[0136] 2 options are available:
[0137] Option “A” preferred and automatically activated by default:
[0138] The search for the nest, and its designation as the target to be hit, are fully automatic,
[0139] Option “B”, semi-automatic option to be used only if “A” fails:
[0140] The designation of the target is done by the operator.
MO-4A Automatic Option (Nest Designation by the Drone Software)
[0141] Operator: [0142] Does nothing and remains a simple observer:
[0143] The minimum altitude “altiMini” from which the drone should start searching for the nest, and the maximum altitude “altiMaxi” at which the drone should give up if it has not found the nest are already in the mission parameters.
[0144] The drone: [0145] Climbs vertically at fast speed to the minimum altitude altiMini. [0146] Executes in loop the following algorithm described in pseudo code:
[0147] n=0 (n is the index of the increment)
[0148] Loop
n=n+1
[0149] Goes up deltaAlti cm, always vertically, staying at NestHeading
[0150] Takes a photo phot(n) with its main camera facing forward.
[0151] Counts the white pixels nbPix(n) in the photo phot(n).
[0152] Memorizes its altitude alti(n) when taking the photo phot(n)
[0153] Stores the rank n1 of the first photo with white pixels
[0154] Memorizes the n2 rank of the last photo with white pixels
[0155] End of loop if n>n2” or alti(n)>altiMaxi
[0156] End of loop
[0157] Calculates the nMaxi rank of the photo containing the maximum of white pixels. This is the rank of the best framed nest photo.
[0158] Descends by chip jumps of deltaAlti cm to the altitude A(nMaxi). This is the approximate altitude of the nest to be eliminated.
[0159] Takes at this altitude a photo phot(nMaxi) in high definition.
[0160] Analyzes this photo by a known algorithm of the following type:
[0161] Defines a matrix initialized to 0 of all the pixels of the image phot(nMaxi)
[0162] Scans line by line all this image
[0163] Marks with a 1 in this matrix all the pixels recognized as white.
[0164] Calculates and generates the envelope rectangle of the image phot(nMaxi) of the nest.
[0165] Designates this rectangle as the target to approach.
MO-4B Semi-Automatic Option (Operator Designates Nest)
[0166] The operator: [0167] Presses once the button 112 on the touch pad screen.
[0168] The drone: [0169] Climbs quite slowly to vertical (20 cm/s or less).
[0170] The operator: [0171] Watches carefully as the image scrolls vertically on the tablet. [0172] Waits for the nest (a big white spot) to appear on this screen.
[0173] Presses a second time the button 112 on the tablet screen when the image of the nest is in the middle of this screen.
[0174] The drone: [0175] Stops its ascent. [0176] Hovers at the approximate altitude of the nest.
[0177] The operator: [0178] DOES NOT USE THE JOYSTICKS of the console (disabled because too dangerous) [0179] Presses buttons 113 to 118 to center the nest image in the middle of the tablet screen.
[0180] There is no button to control the yaw, because the heading 25 of the drone must remain the same.
[0181] Each press on one of the 6 centering buttons moves the drone a few centimeters in the chosen direction: [0182] button 113: +5 cm in altitude [0183] button 114: −5 cm in altitude [0184] button 115: 5 cm forward [0185] button 116: 5 cm backwards [0186] button 117: 5 cm to the left keeping the heading 25 [0187] button 118: 5 cm to the right while keeping the heading 25
[0188] When the nest image is correctly centered:
[0189] The operator: [0190] Surrounds this image with a rectangle on the touch screen, which designates it as the target to follow. [0191] Press the button 112 a third time, which starts the automatic horizontal approach of the drone to the nest.
MO-5 Approaches the Nest, the Target Designated by a Rectangle
[0192] The drone: [0193] Slowly advances toward the nest, maintaining heading and altitude. [0194] Stops, and stays in hover when the bumper of the embarked automaton is at about 20 cm from the base of the nest. [0195] Focuses his front camera on the image of the nest, the big white spot which is now in close-up on the touch pad screen. [0196] Takes a photGrip picture with the best possible definition. [0197] Analyze the photGrip photo to center the white spot. [0198] Calculates the necessary adjustments to aim about 2 cm under the spot, that is to say the branch that supports the nest. [0199] Moves step by step, in small steps of a few centimeters (Forward, Backward, Up, Down, Left, Right), to align its collimator with the calculated aiming point. [0200] Advances very slowly during the allotted timeAll (about 10 seconds). [0201] Collides with the branch on which the nest is hung, by the bumper of the onboard automaton.
MO-6 Control of the Hanging of the Drone to the Branch of the Nest
[0202] The drone: [0203] Checks that it is properly attached to the branch supporting the nest. [0204] Goes in reverse for 3 seconds. [0205] Very slow speed, [0206] Same altitude, [0207] Heading=nestHeading [0208] Measure nest distance nestDist
[0209] If nestDist=N/A (not measurable) or nestDist <=20 cm
[0210] The drone is well attached to the branch
[0211] We can continue
[0212] Otherwise [0213] The drone is not attached to the branch [0214] Alert message on the tablet [0215] We do not try again to grip the branch of the nest. [0216] We don't know why the automaton couldn't grab this branch [0217] We don't know where exactly the drone is. [0218] Big risk of CRASH in the surrounding branches.
[0219] Abandon the procedure and return immediately to the starting point.
[0220] Go directly to step “ MO-9”.
[0221] End if
[0222] If the drone's software is sophisticated enough, there are other ways for it to know if its on-board automaton was able to grab the targeted branch or not.
[0223] The important thing is that the drone makes sure, whatever the method used, and that it reacts accordingly,
MO-7 Section of the Branch Supporting the Nest
[0224] The on-board automaton: [0225] Closes its gripper (clamp 61) very quickly.
[0226] The advance of the drone towards the nest is now blocked in spite of the maintenance of a weak thrust of its motors.
[0227] The branch on which the nest is installed being rarely vertical, the gripper can pivot during its closing about its horizontal axis, the carrying pole, so that the plane of its jaws remains substantially perpendicular to the axis of this branch.
[0228] The cutting disc of the circular saw is then correctly positioned with respect to the nest's supporting branch, in an optimal position to be cut a few millimeters above the closed gripper.
[0229] The drone: [0230] Remains gripped to the branch in a flexible way by the end of its pole,
[0231] with constant altitude and heading, in quasi-stationary flight in spite of the maintenance of a weak thrust of its engines towards the front.
[0232] The onboard automaton: [0233] Activates the motors of its linear actuators 69 and 89. [0234] The gripper 61 moves backwards from the cutting disc 43. [0235] The counterweight 38 advances to balance the centering. [0236] The branch is cut a few millimeters above the gripper [0237] Reverses the direction of rotation of the motors of actuators 69 and 89. [0238] The gripper 61 advances relative to the cutting disk 43. [0239] The counterweight 38 moves back synchronously to balance the centering. [0240] The drone: [0241] Waits for the expiration of the allocated allTime (about 10 seconds).
[0242] If everything worked well, the nest falls from the tree, and leaves the camera field.
MO-8 Result Check
[0243] The drone : [0244] Remains attached to the uncut part of the branch, because the gripper is under the cutting disk of the circular saw. [0245] Is not destabilized when the nest falls. [0246] Takes a photo with his front camera. [0247] Analyzes the recorded image. [0248] Has the nest disappeared from the image? [0249] Yes : All went well [0250] No: The mission failed,
[0251] The automaton did not manage to cut the branch it was holding on to.
[0252] We can try again, but starting from scratch after repositioning the drone to approach the nest from a different angle.
MO-9 Automatic Gripper Release
[0253] Regardless of the mission outcome, the gripper 61 is still closed.
[0254] The drone: [0255] Switches to reverse at very slow speed. [0256] Opens the gripper. [0257] Corrects its course if it has moved a little bit from nestHeading [0258] Back up about 1 m, at very slow speed to get away from the branches.
MO-10 Return to Home Base
[0259] The drone: [0260] Backs up at normal speed to the vertical of the takeoff mat, following the reverse path of the outward track, a safe route free of any obstacles, the pole always remaining oriented on the starting heading nestHeading. [0261] Descends rapidly over the H of the mat. [0262] Automatically lands on the mat.
MO-11 End of Mission
[0263] Operator: [0264] Turns off all devices. [0265] Carefully cleans the gripper and the cutting disc of the saw. [0266] Checks that the nest has fallen to the ground and has not been caught in low branches.
[0267] If not, drop it with a long pole. Carefully retrieves the fallen nest and places it in a bag for burning it.