Improvement to a method for controlling an autonomous mobile robot and related device

Abstract

The invention concerns a navigation device for a mobile robot comprising means for measuring the amplitude and the phase of an electromagnetic signal emitted by a wire acting as limit for a working area of the robot. The measuring means samples the amplitude of the signal during each time interval, the result of each measurement is stored in a memory and the measurements are repeated for several time intervals, the collected results being added in said memories until the content of a memory reaches a reference threshold. The number of samples required and the content of each memory is interpreted by numerical analysis to determine the distance or distance variation relative to said limiting elements. Any phase change corresponding to a passage beyond the limiting wire is easily detected and results for example in a command returning the robot to its working area.

Description

The present invention relates to a method for controlling an autonomous mobile robot.

In order to limit their displacement, the majority of autonomous mobile units, such as automatic lawn mowers, use an electronic barrier made up of a wire positioned on the periphery of the surface to be covered and in which a low frequency electric signal circulates (for example a few tens of mA at 5 KHz).

The exact knowledge of the amplitude and the phase of the signal allows the robots to be kept located in the interior of the perimeter of the peripheral wire. The utility of the exact measuring of the signal amplitude within the scope of a navigation system for automatic lawn mowers has already been described in patent application PCT/BE98/00038 (U.S. Pat. No. 6,321,515).

The measuring of the signal phase allows the determination of whether the measurement is made on the interior or exterior of the loop generating the magnetic field. By passing through the interior of the loop on the exterior, the lines of force change direction and generate a signal phase change of 180° according to the general laws of electromagnetism.

The object of this invention is to provide an effective and inexpensive measuring device that simultaneously allows the exact measuring of the signal amplitude with a constant signal to noise ratio regardless of the position of the mobile unit on the surface as well as the generation of the phase data that allows the mobile unit to determine with certainty if it is on the interior or exterior of the surface to be covered.

One of the features of the device and method according to the invention consists in the use of a filter for measuring the amplitude, which is a particular variant of a filter adapted to the detection of periodical signals, already used for example in astronomy for the detection of distant stars, called a “multichannel scaler” or “avenger”. This type of filter is described in the literature for example in “The art of electronics”, P. Horowitz, Cambridge University Press 2d Ed. Chap. 15 par. 13 and following.

This type of device carries out several synchronic samplings of the signal amplitude during each period. Each sample is stored in an independent memory (baskets). The measurements are repeated during several periods and the corresponding samples are added in each basket.

In other words, the form of the signal is co-added modulo its period.

The advantage of applying this type of device to a robotic mobile unit is that it allows the simple extraction of the phase and the amplitude of the periodic signal originating from the peripheral wire from the large amount of electrical noise generated by the mobile unit.

At the end of each period the content of the basket is compared with a fixed reference. If the contents of any basket do not exceed the reference value, a counter is increased. After a certain number of repetitions the counter of one of the baskets unavoidably exceeds the referred value. The value of the counter is stored and the counter is reset to zero.

The stored value C of the counter, possibly associated to a calibration operation, allows the determination of the distance of the machine in relation to the peripheral wire. The farther the machine is from the wire, the weaker the signal, and the greater the number of samples necessary to reach the reference value.

The distance may be determined for example by applying the relation C=K*X ((D−X)/D) where two parallel wires are assumed, X is the distance of the mobile unit from the wire, D is the distance between the wires and k is a constant which takes account of the gain of the device.

As can be understood, one of the advantages of this device is that the signal to noise ratio of the measurement remains constant regardless of the signal value, that is to say whatever the distance of the machine relative to the wire is, the selectivity factor of the filter being proportional to the number of samples and the latter being inversely proportional to the signal amplitude.

The totality of the baskets also provides a representation of the shape of the signal. The greater the number of samples per period the more precise the signal shape will be.

The numerical analysis of the waveform by the onboard computer allows the easy detection of a signal phase change, particularly if the latter is asymmetrical.

In the case of a symmetrical signal, a phase reference must be conserved by the onboard computer. This can be obtained either by using a stable local oscillator whose phase follows the peripheral signal phase by means of a PLL, the feedback loop being opened if the mobile unit leaves the enclosure, or by using a second coil positioned on one side of the mobile unit. In the latter case, when the machine cross the limit, one of the coil is located outside and the other one inside the limit defined by the peripheral wire. The phase difference is detected immediately and the machine will come beck entirely within the working surface.

It should be noted that independently of the detection of the 180° phase change caused by the passing over the peripheral wire, the system is also capable of detecting a phase modulation generated by the peripheral wire generator, and therefore is also capable of receiving a message sent by the peripheral wire to the machine. This message may be a parameterisation message or a control message, for example for instructing the return of the robot to the recharging station.

In summary the invention provides thus among others a navigational device for mobile robot comprising a microprocessor and a means for measuring the amplitude of an periodic electromagnetic signal of low frequency produced by one or several limiting elements, for example a wire, located at the periphery of the working surface of said mobile robot, said measuring means effecting a sampling of the amplitude of the signal during each period, the result of each sampling measurement being stored in a independent memory and the measurements being repeated during several periods, the collected results being added in said memories until the content of one memory reach a reference value, the number of necessary samplings and the content of each memory allowing the interpretation by numerical analysis performed by the microprocessor in order to determine the distance or variation of the distance relative to said limiting elements.

The figures provided in the annexes illustrate the invention only in a exemplative way.

FIGS. 1 to 3 show the variation of the content of the baskets after 2, 10, 36 periods, respectively. At the 36th period the content of the basket n°5 exceeds the fixed value of 18 units (reference value).

This number of periods, possibly as well as the accurate value of the contents of the basket n°5, are stored and used by the onboard computer to determine the distance to the peripheral wire. This determination may be relative or absolute. A relative determination is enough if the robotic machine, according to its internal navigational algorithm, must simply follow a path parallel to the peripheral wire.

FIG. 4 shows a block diagram explaining the different phases of the measuring loop.

FIGS. 5 and 6 illustrate the contents of the baskets for a square asymmetrical signal, the machine being on the interior and exterior of the peripheral wire, respectively.

If the content of the baskets for two out-of-phase asymmetric signals of 180° are considered, it is easy to see that in the case of the signal in FIG. 5 there are 4 positive baskets and that in the case of the signal in FIG. 6 there are 12 of them.

The invention may be applied or adapted to machines other than lawn mowers, for example machines for picking up objects or for robotic vacuum cleaners.

Claims

1. A navigational device for a mobile robot comprising a microprocessor and a means for measuring the amplitude of a periodic electromagnetic signal of low frequency transmitted by one or more limiting elements, for example a wire, positioned at a periphery of a work surface of said mobile robot, said measuring means carrying out a sampling of the signal amplitude during each period, the result of each measurement of the sampling being stored in an independent memory and the measuring being repeated during several periods, the collected results being added to said memories until the content of one memory reaches a reference threshold, the number of samplings necessary and the content of each memory being then interpreted by numerical analysis to determine a distance or a variation of a distance of the robot in relation to said limiting elements.

2. The navigation device according to claim 1 wherein the means for measuring the amplitude is also the means for measuring the phase.

3. The navigation device according to claim 2 wherein the numerical analysis detects the shape of the signal and is able to determine a phase change caused by the passing of the robot beyond said limiting elements.

4. The device according to claim 1 wherein the numerical analysis is also capable of detecting a phase modulation generated by the peripheral wire generator, and therefore of receiving a message sent by the peripheral wire to the mobile robot.

5. The device according to claim 4 wherein the message is an instruction to the robot to return to the recharging station.

6. The device according to claim 1 wherein a phase reference is conserved by the onboard computer.

7. The device according to claim 1 adapted to a robotic lawn mower.

8. The device according to claim 1 wherein the frequency of the electromagnetic signal varies from 1 to 15 KHz.

9. The device according to claim 1 wherein the number of sampling per period varies from 4 to 64.

10. The device according to claim 1 comprising two detectors of the amplitude of the periodic signal placed at two different locations of the mobile machine.

11. A method for controlling a mobile robotic machine wherein the mobile robot comprises the device according to claim 1.

12. A method for controlling a mobile robotic machine comprising the measurement of the amplitude and of the phase of a periodic electromagnetic signal of low frequency transmitted by one or several limit elements, for example a wire, located at the periphery of the working surface of said mobile robot, said measuring means effecting a sampling of the amplitude of the signal during each period, the result of each sampling measurement being stored in a independent memory and the measurements being repeated during several periods, the collected results being added in said memories until the content of one memory reach a reference value, the number of necessary samplings and the content of each memory allowing the interpretation by numeric analysis performed by the microprocessor in order to determine the distance or variation of the distance relative to said limiting elements and/or the shape of the periodic signal.

13. A method according to claim 12 wherein an instruction of return is transmitted to the robotic machine when a phase change is detected.