DIFFERENTIAL TRACTION DRIVE AND STEERING AXIS COORDINATION SYSTEM AND METHOD
20230174154 · 2023-06-08
Inventors
Cpc classification
B62D9/002
PERFORMING OPERATIONS; TRANSPORTING
B62D6/002
PERFORMING OPERATIONS; TRANSPORTING
B62D11/003
PERFORMING OPERATIONS; TRANSPORTING
B62D11/10
PERFORMING OPERATIONS; TRANSPORTING
B62D5/0418
PERFORMING OPERATIONS; TRANSPORTING
International classification
B62D11/10
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B62D1/28
PERFORMING OPERATIONS; TRANSPORTING
B62D6/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A system and method for differential traction drive and steering axis coordination for an autonomous mower or other turf device includes initiating a steering motion based on determining a target forward speed and a steering rotational speed, calculating a left wheel speed and a right wheel speed, and applying the left and right wheel speeds, wherein the steering rotational speed is driven by a steering motor and the traction wheels associated with the autonomous mower, and the left and right wheel speeds are based on the target forward speed, a distance from a steering axle to the center of the respective wheel, and the steering rotational speed.
Claims
1. A method for traction control for a device having at least one wheel for providing motion on a surface, comprising: detecting a first wheel slip event of a first wheel having a wheel speed; responding to the first wheel slip event by stopping the first wheel, gradually increasing the wheel speed of the first wheel; detecting a second wheel slip event of the first wheel; and responding to the second wheel slip event by, stopping the first wheel, determining if a steering angle α of the first wheel is less than or equal to a maximum steering angle, adjusting the steering angle α of the first wheel to some first defined angle less than or equal to the maximum steering angle, and gradually increasing the wheel speed of the first wheel while the steering angle is the first defined angle.
2. The method of claim 1, wherein the device is a turf device.
3. The method of claim 1, wherein the surface is a ground surface.
4. The method of claim 1, wherein the maximum steering angle is a predetermined maximum steering angle.
5. The method of claim 4, wherein each operation of gradually increasing the wheel speed of the first wheel is an operation that maintains traction in the form of static friction between the first wheel and the surface.
6. The method of claim 5, further comprising, subsequent to adjusting the steering angle α to a first defined angle, adjusting the steering angle α to a second defined angle opposite to the first defined angle.
7. The method of claim 6, further comprising, subsequent to adjusting the steering angle α to the second defined angle, gradually increasing the wheel speed of the first wheel.
8. The method of claim 7, further comprising, subsequent to adjusting the steering angle α to a second defined angle and gradually increasing the wheel speed of the first wheel, adjusting the steering angle α to a third defined angle greater than the first defined angle and less than the maximum steering angle.
9. The method of claim 8, further comprising, subsequent to adjusting the steering angle α to the third defined angle, gradually increasing the wheel speed of the first wheel.
10. A computer implemented method for traction control for a turf device having at least one wheel for providing motion on a ground surface, comprising: detecting a wheel slip event; responsive to the wheel slip event, stopping motion of the wheel and then gradually increasing a wheel speed; detecting a wheel slip event; stopping motion of the wheel; determining that a steering angle of the wheel is less than or equal to a predetermined maximum steering angle and i) adjusting the steering angle of the wheel; and ii) gradually increasing the wheel speed while the steering angle is less than or equal to a predetermined maximum steering angle.
11. The computer implemented method for traction control of claim 10, wherein adjusting a steering angle of the wheel comprises adjusting the steering angle to a first defined value.
12. The computer implemented method for traction control of claim 11, comprising: subsequent to adjusting the steering angle to a first defined value, adjusting the steering angle to a second defined value opposite to the first defined value; and gradually increasing the wheel speed.
13. The computer implemented method for traction control of claim 12, wherein the first defined angle is increased in successive iterations, and wherein the second defined angle is opposite to the first defined angle.
14. The computer implemented method for traction control of claim 10, comprising stopping operation of the turf device when the steering angle exceeds a predetermined maximum steering angle.
15. The computer implemented method for traction control of claim 10, wherein the steering angle is determined based on data associated with the weight distribution of the turf device.
16. A computer implemented method for traction control for a turf device having a motor for driving two or more traction wheels providing motion over a ground surface, comprising: measuring a motor current; calculating an expected motor current; detecting a wheel slip condition based on a comparison of the measured motor current to the calculated motor current.
17. The computer implemented method for traction control for a turf device of claim 16, comprising: calculating an expected linear velocity associated with the turf device; calculating an expected linear acceleration associated with the turf device; measuring a linear velocity associated with the turf device; measuring a linear acceleration associated with the turf device; and detecting a wheel slip condition based on a comparison of the measured linear velocity to the calculated linear velocity and a comparison of the measured linear acceleration to the calculated linear acceleration.
18. The computer implemented method for traction control for a turf device of claim 16, comprising: calculating an expected rotational acceleration associated with the turf device; calculating an expected linear acceleration associated with the turf device; measuring a rotational acceleration associated with the turf device; measuring a linear acceleration associated with the turf device; and detecting a wheel slip condition based on a comparison of the measured rotational acceleration to the calculated rotational acceleration and a comparison of the measured linear acceleration to the calculated linear acceleration.
19. The computer implemented method for traction control for a turf device of claim 16, comprising: calculating an expected rotational velocity associated with the turf device; calculating an expected rotational acceleration associated with the turf device; measuring a rotational velocity associated with the turf device; measuring a rotational acceleration associated with the turf device; and detecting a wheel slip condition based on a comparison of the measured rotational velocity to the calculated rotational velocity and a comparison of the measured rotational acceleration the calculated rotational acceleration.
20. The computer implemented method for traction control for a turf device of claim 16, comprising: calculating an expected linear velocity associated with the turf device; calculating an expected rotational velocity associated with the turf device; measuring a linear velocity associated with the turf device; measuring a rotational velocity associated with the turf device; and detecting a wheel slip condition based on a comparison of the measured linear velocity associated with the device to the calculated linear velocity associated with the device and a comparison of the measured rotational velocity to the calculated rotational velocity.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038] It should be noted that all the drawings are diagrammatic and not drawn to scale. Relative dimensions and proportions of parts of the figures have been shown exaggerated or reduced in size for the sake of clarity and convenience in the drawings. The same reference numbers are generally used to refer to corresponding or similar features in the different embodiments. Accordingly, the drawings and description are to be regarded as illustrative in nature and not as restrictive.
DETAILED DESCRIPTION
[0039] The following terms are used throughout the description, the definitions of which are provided herein to assist in understanding various aspects of the subject disclosure.
[0040] As used herein, the terms “autonomous mower”, “device”, “turf device”, “robotic mower”, “vehicle” and “robot” refer to an autonomous robot, or most any autonomous device, vehicle or machine that performs various tasks and functions including lawn mowing, lawn maintenance, vacuum cleaning, floor sweeping and the like. Similarly, and as used herein, the terms “autonomous mower”, “robotic mower”, “vehicle”, “turf device”, “device” and “robot” are used interchangeably and refer to most any device, or machine that utilizes both traction and steering mechanisms, wherein the device or machine is not necessarily autonomous.
[0041] The term “traction drum” can include multiple traction wheels, e.g., front, rear, left and/or right traction wheels. The individual traction wheels may be independently controlled by the turf device.
[0042] In the following description, for purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of the subject disclosure. It may be evident, however, that the disclosure can be practiced without these specific details. In other instances, well-known structures and devices are shown in block diagram form in order to facilitate describing the disclosure.
[0043] The disclosed technology can include multiple traction motors, for example, a separate traction motor can be associate with each traction wheel. During a steering operation, for example, when the turf device turns left, the steering turns in a clockwise motion. Because the turf device includes two independent traction motors, the turf device can coordinately command both wheel speeds so that the left wheel rotates forward, and right wheel rotates backwards to assist the steering motor. This coordination allows the required torque from the steering motor to be greatly reduced. The disclosed technology provides robust, continuous steering operation when compared to turf devices or vehicles having similar locomotion designs.
[0044] Advantages of the differential traction drive with steering axis coordination include less stress on the steering motor, faster response for the turn motion, provides a flexible, dynamic implementation of a “differential lock” type feature via software, without additional mechanical components; and better traction control when stuck due to an obstacle such as an irrigation pod, or a sprinkler head.
[0045] In other embodiments, where no steering motor is included, the wheel traction motor(s) can be utilized to control the steering and traction at the same time.
[0046] Referring to
[0047] A drive section (not shown) is connected to steering axle 110 and a steering motor 112 to pivot and direct motion of the left traction wheel 106 and right traction wheel 108 during operation, thus allowing the turf device 100 to alter its path during movement.
[0048] Referring to
[0049] Referring to
[0050] As shown in
[0051] Referring to
[0052]
[0053] Referring to
[0054]
[0055]
[0056] Referring to
[0057] In an embodiment, at the start of the steering motion, to steer the turf device 100 to a desired angle α, and when a is larger than a threshold angle β, can be derived, for example, as:
[0058] assuming the target overall turf device 100 forward speed is Vf (m/s);
[0059] the steering rotational speed is, Ws, which is driven by the steering motor 112 112 and with the traction wheels (rad./sec.); and
[0060] the distance from the steering axle to the center of the left wheel, Dsl (m), which is the same to the right wheel, Dsr (m).
[0061] To match the steering rotational speed, the starting left wheel speed 122, Vls, and the right wheel starting speed 124, Vrs are obtained as:
V/s=Vf+Dsl*Ws
Vrs=Vf—Dsl*Ws
[0062] When applying V/s and Vrs, the steering assembly begins to turn. The overall coordination is shown in
[0063] In an embodiment, at the ending of the steering motion, when reaching the desired steering angle, the ending speed of left wheel Vle, and the right wheel speed Vre can be determined by the following processes:
[0064] As shown in
Dp=Dw/sin(α)
[0065] Where Dw is the distance between the front roller and the steering axle, α is the steering angle, and Dp is the distance from the pivot point to the steering axle. The distance between the front roller and the steering axle can measured from either of a center point, or a leading or trailing edge of the front roller and the steering axle, depending upon for example, the physical configuration of the front roller and the steering axle.
[0066] When the steering assembly turns counter-clockwise (α>0):
Vle=Vf*(Dp−Dsl)/Dp
Vre=Vf*(Dp+Dsr)/Dp
[0067] When the steering assembly turns clockwise and (α<0):
Vle=Vf*(Dp+Dsl)/Dp
Vre=Vf*(Dp−Dsr)/Dp
[0068] In an embodiment, the transition between starting and ending a steering motion is achieved as follows:
[0069] The transition wheel speeds can be applied in between the starting and ending steering motions when the differences angle, γ, between the current steering angle and the desired steering angle α is less than a pre-set threshold angle β.
Vlt=Vls+(Vle−Vls)*((β−Γ)/β)
Vrt=Vrs+(Vre−Vrs)*((β−γ)/β)
[0070] By applying the equations above, the wheel speeds gradually change from the start of the steering motion to the end of the motion, while maintaining the overall motion speed.
[0071] The disclosed system can include two traction motors, or a traction motor for each traction wheel, and a steering motor 112. In aspects, the disclosed system is overconstrained when compared to conventional systems including a single traction motor, and an open differential. This presents a challenge when optimizing the system, which is addressed by the algorithms disclosed herein, and which rely at least in part on the speed commanded to the motors, and in aspects, speed feedback from the motors. Additional variables can be considered, for example, the current draw of the motors, as well as additional knowledge associated with the dynamics of the system, the autonomous turf device 100, the operating environment, and/or the external terrain. For example, if the external terrain, or the ground surrounding the turf device, slopes in a particular direction, the traction wheels can be directed so that the force of gravity aids in the movement of the turf device 100.
[0072] In embodiments, sensors can be utilized to gather data concerning the operation and steering of the turf device 100. The additional sensors can be included in the body or structure of the turf device 100, can be remote to the turf device 100, or can be located within a work area, or remote to the work area. For example, data can be obtained from rotational encoders, tachometer, gyroscope, accelerometers, inertial measurement unit, odometer, velocity meter, global positioning system (GPS), Light Detection and Ranging (LIDAR), ultra-wideband radar, beaconing systems, Global System for Mobile Communications (GSM) localization, or most any other systems and sensors, and can be combined with data received via sensors included on the turf device 100.
[0073] A processing component includes hardware, software, and/or firmware components configured to receive, sample, filter, convert, process and use data, for example, data associated with the differential traction drive with steering axis coordination systems, and other sensors and inputs.
[0074] In an embodiment, processing component includes a microprocessor, data processing hardware and software, memory, and other associated hardware, software and algorithms for differential traction drive with steering axis coordination systems of the turf device 100. Processing component can perform operations associated with analog to digital signal conversion, signal sampling, signal filtering, execution of the disclosed algorithms, and other algorithms, evaluation of data, information determination, location determination, and most any other function related to differential traction drive with steering axis coordination.
[0075] The disclosed differential traction drive with steering axis coordination systems and methods can be implemented as “computer readable instructions”, algorithms and/or modules for execution by the processing component. Computer readable instructions can be provided as program modules, such as functions, objects, Application Programming Interfaces (APIs), data structures, and the like, that perform particular tasks or implement particular abstract data types.
[0076] In further embodiments, the disclosed system and method can function in a mode in the event the turf device 100 becomes stuck, or starts slipping. The combined system can be re-optimized with the goal of maximizing tractive force whereby it temporarily foregoes the goal of achieving a particular traction speed and focuses on regaining traction. For example, the steering is set straight and the turf device 100 smoothly accelerates both traction motors, so they match speed. Other embodiments can utilize a kinematic model of the system including weight distribution as well as a model for the terrain to maximize the tractive force applied by the turf device 100 to the ground.
[0077] In an embodiment, when the external terrain, or the ground surrounding the turf device, slopes in a particular direction, the traction wheels can be directed so that the force of gravity aids in the movement of the turf device 100. Likewise, data associated with the weight distribution of the turf device 100 can be used in determining a steering angle.
[0078] In an embodiment, a computer implemented method for traction control for a turf device 100 having at least one traction wheel for providing motion on a ground surface includes detecting a wheel slip event, and responsive to the wheel slip event, stopping motion of the wheel and then gradually increasing a wheel speed, detecting a wheel slip event, stopping motion of the wheel, determining if a steering angle of the wheel is less than or equal to a predetermined maximum steering angle and adjusting a steering angle of the wheel, and gradually increasing the wheel speed while the steering angle is less than or equal to a predetermined maximum steering angle.
[0079] Adjusting a steering angle of the wheel can include adjusting the steering angle to a first defined value. The steering angle can be adjusted to a second defined value that is opposite to the first defined value subsequent to adjusting the steering angle to the first defined value, and then gradually increasing wheel speed and detecting a wheel slip event. The number of defined values (first, second, third, . . . values) can be subject to the applications. A greater number of defined values causes the turf device 100 to make successive attempts to regain traction. The first defined angle can be increased in successive iterations, and the second defined angle can be opposite to the first defined angle.
[0080] In an embodiment, a computer implemented method for detecting wheel slip for a turf device 100 having at least one wheel 106, 108 for providing motion over a ground surface includes measuring a motor current associated with the turf device 100, calculating an expected turf device 100 motor current, determining a wheel slip condition based on a comparison of the measured motor current to the calculated device motor current.
[0081] In further embodiments, a computer implemented method for detecting wheel slip for a turf device 100 having at least one wheel 106, 108 for providing motion over a ground surface includes measuring a linear velocity and accelerations associated with the turf device 100, measuring a rotational velocity associated with the turf device 100, calculating an expected linear velocity and acceleration associated with the turf device 100, calculating an expected rotational velocity and acceleration associated with the turf device 100, determining a wheel slip condition based on a comparison of the measured linear velocity and accelerations associated with the turf device 100 to the calculated linear velocity and accelerations associated with the turf device 100, and determining a wheel slip condition based on a comparison of the measured rotational velocity associated with the turf device 100 to the calculated rotational velocity associated with the turf device 100.
[0082]
[0083] At act 706, a left wheel starting speed V/s and a right wheel starting speed Vlr can be determined and applied. The starting wheel speeds can be determined based on, for example, the target forward speed, a distance from a steering axle to the center of the respective wheel, and the steering rotational speed.
[0084] At act 708, the turf vehicle is a left wheel transition speed Vlt and a right wheel transition speed Vlt can be determined and applied, based on for example, the respective starting and ending wheel speeds, and the differences between the current steering angle and the desired steering angle. In an embodiment, the left and right wheel transition speeds are calculated and applied when the difference between the current steering angle and the desired steering angle is less than a predetermined threshold angle.
[0085] At act 710, the turf vehicle is a left wheel ending speed Vle and a right wheel ending speed Vle can be determined and applied, based on for example, the desired turf device speed, a distance from the steering axle to the center of the respective wheel, and a distance from the pivot point to the steering axle. The pivot point can be calculated based on the distance from the front roller to the steering axle, and the desired steering angle.
[0086] The application of the starting wheel speeds, the transition wheel speeds, and the ending wheel speeds as detailed above provide a coordinated steering motion wherein the left and right wheel speeds gradually change from the start of the steering motion to the end of the motion, while maintaining the overall motion speed of the turf device 100.
[0087]
[0088] The method 800 can be utilized to identify a traction issue by detecting, for example, wheel slip. Wheel slippage can be detected by determining an amount of electrical current applied to the motors. When a traction wheel is slipping/spinning on the turf, the current drawn by the motor will be less than expected. In an embodiment, traction wheel slipping/spinning can also be detected by determining the motion of the turf device 100 with respect to the steering angle and traction drum speed. In further embodiments, traction wheel slipping and/or spinning can be detected utilizing a measurement of the turf device's linear velocity and rotational velocity and a kinematics model of the turf device 100, and/or a measurement of the turf device's linear acceleration and rotational acceleration and a dynamics model of the turf device 100. For example, a kinematics model of the turf device 100 is utilized to estimate the turf device's linear velocity and rotational velocity with the commanded drum steering angle and drum speed, and a dynamics model of the turf device 100 is utilized to estimate the turf device's linear acceleration and rotational acceleration with the commanded traction drum steering angle and traction drum speed.
[0089] The present motion of the turf device 100 in linear velocity, rotational velocity and accelerations can be measured using sensors such as GPS, IMU LiDAR and/or AHRS, and the like. An estimated turf device 100 response and the measured result are compared to determine if the turf device 100 is experiencing slipping or spinning of the traction wheel or wheels. With reference to
[0090] At act 806, a measurement of the motor current is obtained. The measured motor current is compared to the expected motor current at step 810.
[0091] Still referring to
[0092] In aspects, the measurements and comparisons performed at steps 806, 808, 810, and 812 are completed multiple times in an iterative manner, and the results can be averaged or weighted value at step 814. The comparison at step 814 can be conducted utilizing the weighted or averaged motor current measurements, and/or weighted or averaged linear and rotational velocity measurements, and linear and rotational acceleration measurements obtained at steps 806 and 808.
[0093] In an embodiment, traction wheel slip is indicated when the measured motor current differs from an expected motor current by a predetermined threshold. In aspects, traction wheel slip is indicated when the measured turf device 100 velocities and accelerations differ from the estimated linear and/or rotational velocities and the estimated linear and/or rotational accelerations of the turf device 100 by a predetermined threshold. In other embodiments, a combination of the data from the comparison of the measured motor current to an expected motor current and data from a comparison of the measured turf device 100 velocities and accelerations to the estimated or calculated velocities and accelerations of the turf device 100 is used to determine traction wheel slip.
[0094]
[0095] If no traction issues are detected, for example utilizing method 800, the turf device 100 resumes normal operation at step 906. If the turf device 100 remains stuck, i.e. one or more wheels are indicated as slipping, the drum can be stopped, and then the drum speed gradually increased to exploit greater traction, for example in the form of static fraction, at step 904. As in step 902, if no traction issue is detected, the turf device 100 resumes normal operation at step 906, and the method 900 ends at step 918.
[0096] If the turf device 100 continues to remain stuck, the turf device 100 can perform one or more maneuvers to break free. At step 908, the wheel is stopped and then turned or steered in a defined angle based on, for example, a measured incline. Motion of the wheel is then gradually re-started. If no traction issue is detected subsequent to the maneuver of step 908, the turf device 100 resumes normal operation at step 906, and the method 900 ends at step 918.
[0097] If the turf device 100 continues to remain stuck, the turf device 100 can perform the maneuver of step 910 where the wheel drum is stopped, and then steered in an angle opposite to, or different from, the defined angle in step 908. The wheel is then engaged and driven at a relatively low speed to exploit static fraction present between the wheel and the ground, or obstacle. For example, if wheel slip is indicated after step 908 at a steering angle of 30 degrees, then the wheel can be turned to −30 degrees at step 910, and the wheel speed gradually increased to avoid slippage. If no traction issue is detected subsequent to the maneuver of step 910, the turf device 100 resumes normal operation at step 906, and the method 900 ends at step 918.
[0098] While the turf device 100 remains stuck, the turf device 100 can perform the maneuver of step 912 where each wheel drum is stopped and then steered in an angle different from its present steering angle, and then the wheel speed gradually increased. In an embodiment, the steering angle of step 912 is increased when compared to the steering angle of step 910.
[0099] For example, if the wheel remains stuck at −30 degrees, the wheel is turned to 45 degrees, and then −45 degrees, and so on. The wheel is engaged at each successive angle, and the wheel speed is gradually increased to avoid slippage. If no traction issues are detected subsequent to the maneuvers of step 912, the turf device 100 resumes normal operation at step 906, and the method 900 ends at step 918.
[0100] The maneuvers of steps 908, 910 and 912 can be repeated at increasing steering angles until a predetermined maximum steering angle has been detected as met or exceeded at step 914, and at which point operation of the turf device 100 is halted 916 and the method 900 ends at step 918.
[0101] While, for purposes of simplicity of explanation, the methodology illustrated in
[0102] While embodiments of the disclosed differential traction drive with steering axis coordination systems and methods have been described, it should be understood that the differential traction drive with steering axis coordination systems and methods are not so limited and modifications may be made without departing from the disclosed differential traction drive with steering axis coordination systems and methods. The scope of the differential traction drive with steering axis coordination systems and methods are defined by the appended claims, and all turf devices, processes, and methods that come within the meaning of the claims, either literally or by equivalence, are intended to be embraced therein.