This invention relates to robotic lawn mowers, and more specifically to a boundary sensing system for a robotic mower.
Robotic mowers may include boundary sensing systems to detect the boundary wire. Boundary sensing systems may detect if the robotic mower is inside or outside the boundary wire. When the robotic mower reaches the boundary wire, a vehicle control unit may prompt the traction drive to stop and/or turn around. A boundary sensing system is needed that also can accurately and reliably determine the distance of a robotic mower to the boundary wire.
The present invention provides a robotic mower boundary sensing system with a boundary driving circuit on a charging station transmitting an encoded signal on a boundary wire, a boundary sensor on a robotic mower and including an inductor receiving the encoded signal, and vehicle control unit on the robotic mower receiving the encoded signal from the boundary sensor and decoding the signal and cross correlating the received signal to determine the distance of the boundary sensor from the boundary wire.
In one embodiment shown in
Vehicle control unit 101 may be a printed circuit board assembly that serves as the main control board for the robotic mower. The vehicle control unit may interpret and process information from various sensors, and use that information to control and operate the pair of traction motors to drive the robotic mower over a yard in order to maintain the lawn, and to drive the blade motor. For example, the vehicle control unit may be connected to a number of sensors including one or more boundary sensors 119, as well as one or more obstacle sensors or accelerometers. The vehicle control unit also may communicate with the battery pack in order to monitor the status of the battery pack to maintain a charge for one or more lithium ion batteries in the battery pack. The vehicle control unit also may be connected to a user interface module including an LCD display along with several indicator lights and key buttons for operator input.
In one embodiment, the vehicle control unit may include a microcontroller such as an LQFPSTM32F103ZET6 processor from ST Microelectronics. The microcontroller may have 512 kB of internal flash memory and 64 kbytes of internal RAM. The microcontroller may contain an ARM Cortex M3 core, may run at a maximum core clock frequency, and may use an onboard AtoD converter. The vehicle control unit may contain external static random access memory (SRAM) connected to the microcontroller with a 16 bit FSMC bus and have a minimum capacity of 1 Megabit.
In one embodiment, the vehicle control unit may include three external EEPROM integrated circuits. For example, the EEPROMs may each be 125 kilobyte ICs for a total capacity of 384 kilobytes. The EEPROMs may use and SPI interface to the microcontroller and may be used to store configuration data. The vehicle control unit may use the microcontroller's internal real time clock module.
In one embodiment, the vehicle control unit may interface and control a blade motor controller to power and control blade motor 112 that drives the cutting blade on the robotic mower. For example, blade motor 112 may be a permanent magnet brushless DC motor, such as the EBM Papst 63.20 BLDC motor having a typical output shaft speed range of about 4000 rpm. The vehicle control unit may have three inputs which receive signals from hall effect rotor position sensors contained in the blade motor, such as Melexis US 2884 Hall effect sensors. The vehicle control unit may sense the speed of the blade motor using feedback from the Hall effect sensors, and may sense the current through the blade motor phases combined.
In one embodiment, the vehicle control unit may be connected to traction motor controllers for each of the left and right traction motors 110, 111. Each traction motor may be a permanent magnet brushless DC motor, such as a EBM Papst 42.20 BLDC motor having a typical output shaft speed range of about 2080 rpm. The vehicle control unit may have three inputs which receive signals from Hall effect rotor position sensors, such as the Melexis US2884 Hall effect sensor contained in each traction motor. The vehicle control unit may sense the speed of each traction motor using a feedback from a hall sensor, and may sense the current through the traction motor phases combined.
Still referring to
In one embodiment, boundary drive circuit 106 may be contained in charging station 105, and may drive signals on the main boundary wire and the inner wire. The fundamental frequency of the waveform on the main boundary wire may be about 2 kHz. The robotic mower may have a boundary wire sensor 119 to detect the waveform and provide a signal to the vehicle control unit to indicate the distance of the sensor to the main boundary wire.
In one embodiment shown in the block diagram of
In one embodiment, the boundary driving circuit may transmit a unique ID on the main or outer boundary wire loop ten times per second in block 201. In block 203, the boundary driving circuit may encode the ID with a 4 bit Barker code to improve the signal to noise ratio and reduce susceptibility to noise interference. The resulting 1's and 0's are called chips. A process gain of 6 dB may be achieved with four chips, where process gain is the ratio of chip rate to data rate. In block 205, the microprocessor may encode the Barker coded ID using Manchester encoding to ensure there always is a line voltage transition for every bit or chip.
In one embodiment, in block 207, one or more boundary sensors on the robotic mower may receive the encoded boundary wire magnetic signal, and send the signal to the vehicle control unit. In block 209, the vehicle control unit may amplify the received signal. In block 211, the vehicle control unit's analog to digital converter may sample the amplified signal, preferably at a rate of 200 kHz. In block 213, the vehicle control unit may buffer the sample data for further processing. The boundary wire magnetic signal may be very small and similar in amplitude to the background noise if the robotic mower is a significant distance from the main boundary wire loop. This limits the amount of amplification that can be applied to the signal, and it may be difficult to detect the signal using traditional hardware/software methods.
In one embodiment, in block 215, the vehicle control unit may cross correlate the received signal (at the boundary sensor's present position) with a known waveform (at a known distance to the boundary wire) to identify the start bit in the data buffer and determine if the data is inverted, indicating the sensor is outside the main boundary loop, or normal, indicating the sensor is inside the main boundary loop. The peak to peak amplitude of the known waveform may be the theoretical maximum that the boundary sensor and vehicle control unit can receive without distorting the signal. Cross correlation is done by converting the known waveform data and the sampled waveform data from the time domain into the frequency domain. This may be accomplished by running a FFT on the data, multiplying the FFT results together, and then running an inverse FFT on the result of that product.
In block 217, the vehicle control unit may decode the Manchester and Barker coding, and verify the ID against the identification stored in non-volatile memory. In block 219, the vehicle control unit may determine the relative distance of the sensor from the outer boundary wire. The cross correlation function may provide the time lag difference between the known waveform (at a known distance to the boundary wire) and the unknown received sampled waveform (the boundary sensor's distance to the boundary wire). The location in time of the maximum peak value of the lag provides the starting location in time of the transmitted data packet located in the sampled waveform data. The amplitude of the lag is proportional to the difference between the known waveform's maximum amplitude and the received sample data's maximum amplitude. For example, if the known waveform has a maximum peak value of 1.65 volts or 2048 A/D (0.000805 volts per count) counts, and the resulting cross correlation lag value is 360, the peak amplitude of the sampled data is 360*0.00805=0.2898 volts.
In one embodiment, the robotic mower may have one boundary sensor to indicate proximity of the sensor to the wire.
In one embodiment, sense coil L1 may be an inductor that detects the magnetic field generated by the current flowing in the main or outer boundary wire and/or inner boundary wire. For example, sensor coil L1 may be a 100 mH 10% inductor Bournes RL622-104K-RC. The maximum peak voltage of the sense coil L1 may be approximately 75 mV when the sensor is located six inches from the boundary wire.
In one embodiment, the boundary sensor circuit may include a quad op amp with transimpedance amplifier U1-A, band pass filter U1-B, variable gain amplifier U1-C, and comparator U1-D. For example, the quad op amp may be a National Semiconductor LMV6484IMX Op Amp (Quad). A valid signal from the final stage output of the quad op amp may be greater than about 100 mV.
In one embodiment, transimpedance amplifier U1-A may convert the current induced in sense coil L1 into a voltage and amplify that voltage. Resistor R1 may convert the output current from sense coil L1 into a voltage. The output voltage of the transimpedance amplifier may be equal to the input current multiplied by the feedback resistor R1. For example, resistor R1 may be 100 kΩ. Capacitor C1 may provide stability to prevent the transimpedance amplifier from oscillating. Oscillation may be the result of capacitance of the input sensor and the op amp itself. For example, C1 may be a 47 pF 50V 10% C0G ceramic capacitor.
In one embodiment, band pass filter U1-B may provide a second order Sallen-Key high pass filter to cancel noise such as low frequency noise from the traction wheel motors of the robotic mower. Capacitors C2 and C3 and resistors R2 and R3 may set the corner or roll off frequency of the filter. For example, R2 and R3 may be 1 Meg Ohm 1/16 W 1% resistors, and C2 and C3 may be 100 pF 50 V 5% C0G ceramic capacitors. The output of the high pass filter may be followed by resistor R4 and capacitor C4, which may perform low pass filtering. For example, R4 may be a 10.0 k 1/16 W 1% resistor, and C4 may be a 47 pF 50V 10% C0G ceramic capacitor. Capacitor C5 may be a decoupling capacitor with a voltage rating high enough for the maximum voltage on the +5V power supply. For example, C5 may be a 0.1 pF 16V 10% X7R MLC capacitor.
In one embodiment, the quad op amp also may include variable gain amplifier U1-C. Resistors R5 and R6 may set the gain of the variable gain amplifier, and resistor R6 may provide the negative feedback. For example, R5 may be a 10.0 k, 1/16 W, 1% resistor, and R6 may be a 100 kΩ, 1/16 W 1% resistor. Dual diode D1 may automatically reduce the gain when the received signal strength is higher, such as when the robotic mower is very near the boundary wire. If the output voltage of variable gain amplifier U1-C is too high, one of the pair of diodes D1 may conduct and clamp the voltage across resistor R6, reducing the gain. As the input voltage to the amplifier increases, a point will be reached where the diodes conduct. Beyond this point the feedback from the output to the inverting input will be equal to the voltage across the diode. For example, D1 may be an NXP BAV99LT1G high-speed switching dual diode.
In one embodiment, the boundary sensor circuit also may include unity gain buffer U2-A to buffer the output of variable gain amplifier U1-C before connection to the vehicle control unit via a wiring harness. For example, unity gain buffer U2-A may be a National Semiconductor LM771 op amp. Capacitor C7 may be a bypass capacitor for unity gain buffer U2-A. For example, capacitor C7 may be a 0.1 pF 16V 10% X7R MLC capacitor.
In one embodiment, the boundary sensor circuit may include comparator U1-D which may form a Schmitt trigger comparator circuit to provide an output that indicates whether or not the received signal strength is great enough to be considered a valid signal. If the received signal is greater than the threshold, the output of the comparator will be high. Resistors R7 and R8 may form a voltage divider used to set the threshold for a valid signal, indicating a valid signal instead of noise. For example, R8 may be a 5.62 k, 1/16 W 1% resistor, and R7 may be a 200Ω 1/16 W 1% resistor. Resistors R9 and R10 may configure the hysteresis of the comparator, with R10 providing the positive feedback. R9 and R10 together set the upper and lower thresholds of the Schmitt trigger comparator. For example, R9 may be a 5.62 k 1/16 W 1% resistor and R10 may be a 1 Meg Ohm 1/16 W 1% resistor.
In an alternative embodiment, the robotic mower may have a plurality of boundary sensors 119, and most preferably three boundary sensors mounted at or near the front of the robotic mower and a fourth boundary sensor mounted at or near the back of the robotic mower. The vehicle control unit may receive input from each of the boundary sensors regarding strength of the signal from the main boundary wire to indicate proximity of the sensor to the wire.
In the alternative embodiment described in
In one embodiment, in block 314, the vehicle control unit determines which of the four possible heading quadrants the robotic mower is in relative to the main boundary wire. For example, if Δ1 is greater than or equal to 0 and Δ4 is less than or equal to zero, the heading is in quadrant 1. In block 316, the vehicle control unit calculates the heading angle of the robotic mower given the heading quadrant from the preceding step. For example, in quadrant 1, the angle θ=360 degrees−arcsin(Δ1/L1)×180 degrees/π. The angle θ of the mower will be within the range from 0 degrees to 360 degrees. In block 318, the vehicle control unit may flip the angle for readings outside the main boundary wire.
In one embodiment, the vehicle control unit may select the type of area coverage used by the robotic mower for mowing within the main boundary wire. Using the steps described below in the block diagram of
In one embodiment shown in the block diagram of
In one embodiment, in block 405 the vehicle control unit may determine if a bump is detected, indicating the robotic mower has contacted an obstacle. Bump detection may be provided to the vehicle control unit by one or more accelerometers attached to the chassis and/or top cover of the robotic mower. The accelerometer may be a three axis accelerometer such as the ST LIS302DL which also may be used to sense lifting and orientation, and may communicate to the microcontroller with a SPI bus at the voltage logic level of the microcontroller. If the accelerometer indicates an obstacle is bumped, in block 406 the vehicle control unit may command both traction motors to reverse direction for a specified distance or duration and then turn the robotic mower around.
In one embodiment, if no bump is detected, in block 407 the vehicle control unit may determine if a specified coverage such as boundary coverage was executed within a specified preceding time period such as seven days. The vehicle control unit memory may store data on the type of coverage executed for a specified preceding time period. If boundary coverage was not executed during the specified preceding time period, in block 408 the vehicle control unit may command the traction motors to execute boundary coverage. Preferred boundary coverages are described below.
In one embodiment, if the specified boundary coverage was executed within the preceding time period specified in block 407, in block 409 the vehicle control unit may determine if the robotic mower is closer to the boundary or perimeter wire than a specified distance, using input from one or more boundary sensors 119. If the robotic mower is closer than the specified distance, in block 410 the vehicle control unit may command the traction motors to reverse direction for a specified duration and then turn the robotic mower around.
In one embodiment, if the robotic mower is not closer than the specified distance to the boundary wire, in block 411 the vehicle control unit may determine if the wheel motors are currently executing the reverse and turn around function. If the motors are still in reverse for the prespecified distance or duration, or have not finished turning the robotic mower around, in block 412 the vehicle control unit may command both traction wheel motors to continue the reverse and turn around functions.
In one embodiment, if the vehicle control unit determines the reverse and turn around function is currently active, in block 413 the vehicle control unit may determine if the blade load is greater than a first predetermined specified value X which indicates uncut grass. Higher current means higher blade load and torque, indicating longer, uncut grass. Lower current, lower blade load and torque, indicates shorter, cut grass. If the blade load is greater than the first value, in block 414 the vehicle control unit may command the traction wheel motors to execute local area coverage. A preferred local area coverage is described below.
In one embodiment, if the blade load is not greater than the predetermined specified value X, in block 415 the vehicle control unit commands the traction wheel motors traction motors to execute wide area coverage. A preferred wide area coverage is described below.
In one embodiment, the vehicle control unit may execute wide area coverage by commanding the left and right wheel motors to drive the robotic mower in a straight line until an obstacle or boundary wire is encountered. When the robotic mower encounters the boundary wire or obstacle, the vehicle control unit may command the wheel motors to reverse and back up the mower for a prespecified distance and then turn the robotic mower around, preferably less than 180 degrees, to follow a path that diverges from the preceding forward path. Alternatively, the vehicle control unit may specify and execute other methods of wide area coverage, including but not limited to traveling in arcs instead of straight lines.
In a preferred embodiment shown in the block diagram of
In one embodiment, in block 504 the vehicle control unit determines if the robotic mower has bumped an obstacle, as indicated by one or more accelerometers, for example. If the robotic mower has detected an obstacle, in block 508 the vehicle control unit may command both traction wheel motors to rotate in reverse to back up at a reduced ground speed, and to maintain the same yaw angle. If the robotic mower has not bumped an obstacle in block 504, the vehicle control unit may determine if one or more boundary sensors indicate the mower is closer to the main boundary wire than a prespecified threshold distance in block 506. If one or more boundary sensors indicate the robotic mower is not close to the main boundary wire, the vehicle control unit commands the left and right wheel motors to continue rotating forward as indicated in block 502. If the boundary sensor(s) indicate the robotic mower is close to the main boundary wire, in block 508 the vehicle control unit may command the wheel motors to rotate in reverse at a reduced ground speed, and to maintain the same yaw angle. In block 510, the vehicle control unit may determine if the traction wheel motors have rotated in reverse a prespecified or threshold time or distance. If the traction wheel motors have not rotated the prespecified time or distance in reverse, the vehicle control unit may command the motors to continue in reverse as indicated in block 510.
In one embodiment, once the traction wheel motors have rotated for the threshold distance or time in reverse, in block 512 the vehicle control unit may set a target yaw angle at a prespecified angle, preferably less than 180 degrees, and command the left and right wheel motors to turn the robotic mower around at a ground speed of zero. In block 514, the vehicle control unit determines the turn error from the target yaw angle. In block 516, once the turn angle reaches the target yaw angle, the vehicle control unit may command the traction wheel motors to rotate in forward again at a nominal speed and maintain the same yaw angle (i.e., 0 degrees), as specified in block 502. If the turn angle has not reached the target yaw angle yet, the vehicle control unit will command the traction wheel motors to continuer turning the robotic mower around, and then calculate the turn error again in block 514.
In one embodiment, local area coverage may be a path that spirals outwardly, either clockwise or counterclockwise, from the robotic mower's initial position. Alternatives for local area coverage may include other patterns starting from an initial position of the robotic mower. As shown in the block diagram of
In one embodiment, the robotic mower may execute boundary coverage, or return to the charging station, on a path along or parallel to the boundary wire using the system described in the block diagram of
As shown in
In an alternative embodiment, the vehicle control unit may command the robotic mower to execute boundary coverage using one or more patterns along the boundary or perimeter wire. This boundary coverage may use a pattern that minimizes turf damage or rutting along the boundary due to repetitive wear from the robotic mower's traction drive wheels and caster wheels. For example, boundary coverage may use variable traffic patterns such as a zig-zag pattern to shift the wheel tracks each time the robotic mower executes boundary coverage along the boundary or perimeter wire. Other alternatives also may be specified by the robotic mower controller for boundary coverage, including but not limited to sine or square wave patterns along the boundary or perimeter wire.
In one embodiment, the vehicle control unit may use information received from one or more boundary sensors regarding the distance of the robotic mower to the boundary wire, to alternate the robotic mower's path between driving toward and away from the boundary wire at a specified angle. For example, as shown in
In one embodiment, the robotic mower's path along the boundary wire may change or shift each time it executes boundary coverage. The shift ensures that the same turf is not repeatedly contacted and compacted by the robotic mower's wheels. The shift may occur because the robotic mower will often have a different starting position each time it starts executing boundary coverage. Additionally, a shift may result from changing the boundary coverage pattern by including variables in the vehicle control unit logic such as the minimum and maximum distances used to toggle the desired orientation, or using a different angle other than 45 degrees.
In one embodiment, the vehicle control unit may vary the distance of the robotic mower's path when the robotic mower executes home finding to return to the charging station. The vehicle control unit may specify a return path that is offset from the main boundary wire, and varies over a range of available paths between a minimum offset and a maximum offset. By varying the offset from the main boundary wire, the traction drive wheels of the robotic mower will not wear or damage the turf along the wire. The minimum and maximum allowable offset from the main boundary wire may be preselected or constant. Alternatively, the offset may be incremented or reduced each time the robotic mower returns to the charging station.
In one embodiment, as shown in
In one embodiment, the vehicle control unit memory may record and store the time when an obstacle or boundary wire has been last detected, and may determine the robotic mower is stuck if a prespecified amount of time elapses before the robotic mower encounters an obstacle or boundary wire again. Preferably, an accelerometer or similar device may be used to detect obstacles, and one or more boundary sensors may be used to detected the boundary wire. The timer duration may be prespecified by the operator or as a function of the size of the area to be mowed, obstacle density, vehicle speed and navigation rules. Additionally, the timer duration may be a function of the type of area coverage being executed by the robotic mower.
In one embodiment, the timer duration may be the product of the expected maximum distance between obstacles or boundaries, and the robotic mower's expected travel speed. The timer duration may be relatively short during boundary coverage because the vehicle control unit expects to encounter the boundary again after traveling only a short distance. The timer duration for wide area coverage may be determined from the maximum span between opposite boundaries if the robotic mower travels in a straight line.
In one embodiment, as shown in
Having described the preferred embodiment, it will become apparent that various modifications can be made without departing from the scope of the invention as defined in the accompanying claims.
This is a continuation and claims priority of application Ser. No. 12/845,326 filed Jul. 28, 2010, that application incorporated by reference in its entirety in this present application.
Number | Name | Date | Kind |
---|---|---|---|
6300737 | Bergvall et al. | Oct 2001 | B1 |
6465982 | Bergvall et al. | Oct 2002 | B1 |
7574282 | Petersson et al. | Aug 2009 | B2 |
7613543 | Petersson et al. | Nov 2009 | B2 |
20080097645 | Abramson et al. | Apr 2008 | A1 |
Number | Date | Country |
---|---|---|
1612631 | Jan 2006 | EP |
Entry |
---|
KA LawnBott. Product Brochure. Kyodo America, KA Home Robotics, Lawrenceville, GA <URL:http://www.lawnbott.com/>. |
Number | Date | Country | |
---|---|---|---|
20130211625 A1 | Aug 2013 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 12845326 | Jul 2010 | US |
Child | 13724112 | US |