WO2017177929A1 - 自动工作系统自移动设备及其控制方法 - Google Patents
自动工作系统自移动设备及其控制方法 Download PDFInfo
- Publication number
- WO2017177929A1 WO2017177929A1 PCT/CN2017/080313 CN2017080313W WO2017177929A1 WO 2017177929 A1 WO2017177929 A1 WO 2017177929A1 CN 2017080313 W CN2017080313 W CN 2017080313W WO 2017177929 A1 WO2017177929 A1 WO 2017177929A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- mobile device
- self
- mobile
- satellite navigation
- module
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 55
- 238000003860 storage Methods 0.000 claims description 16
- 230000008092 positive effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 238000012937 correction Methods 0.000 description 6
- 238000005520 cutting process Methods 0.000 description 6
- 238000004891 communication Methods 0.000 description 4
- 230000036544 posture Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 238000005265 energy consumption Methods 0.000 description 3
- 230000007774 longterm Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- 241001417527 Pempheridae Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/485—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0285—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/245—Arrangements for determining position or orientation using dead reckoning
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/247—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons
- G05D1/248—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons generated by satellites, e.g. GPS
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2105/00—Specific applications of the controlled vehicles
- G05D2105/15—Specific applications of the controlled vehicles for harvesting, sowing or mowing in agriculture or forestry
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2107/00—Specific environments of the controlled vehicles
- G05D2107/20—Land use
- G05D2107/23—Gardens or lawns
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2109/00—Types of controlled vehicles
- G05D2109/10—Land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
- G05D2111/50—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors
- G05D2111/52—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors generated by inertial navigation means, e.g. gyroscopes or accelerometers
Definitions
- the invention relates to an automatic working system, a self-moving device and a control method thereof.
- the automatic mower is one of the most commonly used household products, which can be used to automatically perform mowing tasks, trim the lawn, and keep the lawn clean and beautiful.
- Automatic mowers usually use GPS navigation (including DGPS navigation) when performing mowing tasks.
- GPS navigation including DGPS navigation
- Beidou signal navigation may also be used.
- Figure 1 when the automatic mower is walking along obstacles such as fences/trees/flowers (the dotted line in Figure 1 is the shadow formed by obstacles such as fences/trees/flowers), it is caused by occlusion.
- the GPS signal is poor. If you continue to use GPS navigation, it is basically a “blind guide”, which will cause a large error.
- the accurate coordinates will be obtained by long-term solution in place.
- the solution software and hardware are complicated, and the equipment cost increases.
- the device does not move for a certain period of time, which will cause the user to have the illusion of equipment failure, which is not conducive to the promotion and popularization of the equipment.
- the automatic mower can also use its own inertial navigation system for navigation, but according to the working principle of the inertial navigation system (the working principle of inertial navigation is based on Newton's laws of mechanics, by measuring the carrier in inertia The acceleration of the reference frame, integrating it with time, and transforming it into the navigation coordinate system, can get the information of speed, yaw angle and position in the navigation coordinate system.) It can be seen that the inertial navigation system belongs to the estimated navigation. In the way, with the extension of time, the accuracy will be reduced, which is not conducive to the long-term work of the automatic mower.
- DGPS Difference global positioning system
- PRC range correction value
- RTK Real-time kinematic, real-time dynamic difference
- a DGPS mobile station receiving antenna is provided on a mobile device, and a DGPS base station wireless signal transmitting antenna is generally disposed on a charging station of the mobile device, but since the charging station has a low height, the radio wave transmission process may
- the signal attenuation is caused by obstacles such as houses, especially when the mobile device travels to the side of the obstacle, the DGPS base station can basically not communicate with the receiving station on the self-mobile device, so the positioning accuracy of the DGPS is greatly reduced.
- the present invention provides:
- a self-mobile device comprises: a mobile module, a task execution module and a control module; the control module is electrically connected with the mobile module and the task execution module, controls the mobile module to drive the movement from the mobile device, and controls the task execution module to perform the work task;
- the self-mobile device further includes a satellite navigation device electrically connected to the control module, receiving a satellite signal, and outputting current position information from the mobile device; the control module determining whether the quality of the position information output by the satellite navigation device at the current location is satisfied Presetting conditions, if the preset condition is not met, controlling the mobile module to drive the mobile device to change the mobile mode, so that the quality of the location information output by the satellite navigation device in the moved position meets a preset condition.
- the self-mobile device comprises a storage unit electrically connected to the control module and the satellite navigation device; a position at which the quality of the position information output by the satellite navigation device satisfies a preset condition is referred to as a desired position; and the storage unit stores the desired position Information; controlling, by the control module, the mobile module to change the mobile mode from the mobile device comprises: controlling the mobile module to move from the mobile device to the desired location.
- control module determines a distance between the plurality of desired locations stored by the storage unit and a current location of the mobile device, and selects one of a plurality of desired locations according to a distance between the desired location and a current location of the mobile device, and controls the mobile The module drives the mobile device to move to the selected desired location.
- control module controls the mobile module to move from the mobile device to a desired position that is closest to the current location of the mobile device.
- the location where the quality of the location information output by the satellite navigation device does not satisfy the preset condition is referred to as an original location, and the storage unit stores information of the original location;
- the control module controls the mobile module to drive the mobile device back to the original location.
- control module controls the mobile module to drive the mobile device to change the mobile mode
- the control module controls the mobile module to move from the mobile device along a preset path; and the control module controls the mobile module to drive After the mobile device returns to the original location, the mobile module is controlled to continue to move from the mobile device along the preset path.
- the control module controls the mobile module to move from the mobile device along a preset path; the control module determines the current location After the quality of the position information output by the satellite navigation device does not meet the preset condition, the control mobile module drives the mobile device to continue to move the preset time or the preset distance along the preset path, and then changes the movement mode.
- the self-mobile device further includes at least one position sensor electrically connected to the control module to detect a feature related to the position of the mobile device; and when the quality of the position information output by the satellite navigation device does not satisfy the preset condition, The control module determines the current location of the self-mobile device based at least in part on the output of the position sensor.
- the position sensor comprises at least one of a camera, a radar, a capacitive sensor and an inertial navigation sensor.
- the self-mobile device uses the output of the satellite navigation device to correct the output of the position sensor.
- the preset condition includes that the number of satellites that the satellite navigation device receives the signal is greater than or equal to a preset value.
- the present invention also provides an automated working system comprising the self-mobile device of any of the preceding claims.
- the present invention also provides a control method for a self-mobile device, the self-mobile device comprising a satellite navigation device, receiving a satellite signal, and outputting current position information from the mobile device; the self-mobile device control method comprising the steps of: determining a current location Whether the quality of the location information output by the satellite navigation device satisfies a preset condition; if the preset condition is not met, controlling the mobile mode to change the mobile mode, The quality of the position information output by the satellite navigation device at the position after the movement is made to satisfy a preset condition.
- the position at which the quality of the position information output by the satellite navigation device satisfies the preset condition is referred to as a desired position; the desired position information is stored; and the changing the movement mode includes the step of controlling the movement from the mobile device to the desired position.
- determining the distance between the stored plurality of desired locations and the current location of the mobile device selecting one of the plurality of desired locations according to the distance between the desired location and the current location of the mobile device, controlling the selected location from the mobile device to the selected desired location mobile.
- control moves from the mobile device to a desired location that is closest to the current location of the mobile device.
- the location where the quality of the location information output by the satellite navigation device does not satisfy the preset condition is referred to as an original location, and the original location is stored; and the control moves from the mobile device to the desired location. After the location, control is returned from the mobile device to the original location.
- the control moves from the mobile device along the preset path; after the mobile device returns to the original location, the control continues to move along the preset path from the mobile device.
- the control moves from the mobile device along the preset path; after determining that the quality of the location information output by the satellite navigation device does not meet the preset condition, the self-mobile device controls the path along the preset path. Continue to move the preset time or preset distance, and then change the movement mode.
- the self-mobile device further comprises at least one position sensor detecting a feature related to the position of the mobile device; and when the quality of the position information output by the satellite navigation device does not satisfy the preset condition, based at least in part on the position The output of the sensor determines the current location of the self-mobile device.
- the position sensor comprises at least one of a camera, a radar, a capacitive sensor and an inertial navigation sensor.
- the output of the position sensor is corrected by the output of the satellite navigation device.
- the preset condition includes that the number of satellites that the satellite navigation device receives the signal is greater than or equal to a preset value.
- the beneficial effects of the present invention are: moving from a mobile device to a satellite navigation letter
- the mobile device can maintain high-precision navigation by changing the movement mode, and the coverage of the area where the satellite navigation signal is poor can be completed, so that the self-mobile device can complete the coverage of the entire work area with high efficiency.
- the invention also provides a navigation method for a self-mobile device, comprising:
- step (8) If the self-mobile device can receive a stable satellite navigation signal, proceed to step (8);
- the self-mobile device moves the preset time period T from the current position along the preset working direction S by using the inertial navigation mode, and records the position coordinates of the self-moving device corresponding to the movement;
- step (8) If the self-mobile device can receive a stable satellite navigation signal, proceed to step (8);
- the self-moving device moves the preset time period T1 along the preset direction S1 from the position coordinate after the self-moving device moves in the working direction S by the preset time period T by using the inertial navigation method.
- the stable satellite navigation signal can be received after the mobile device moves in the preset direction S1 for a preset time period T1;
- step (3) controlling, by using a satellite navigation method, the self-moving device to return to the position coordinate of the self-moving device after moving in the preset working direction S by the preset time period T in the reverse direction of the preset direction S1, and the The posture is the same before and after the mobile device moves, and proceeds to step (3);
- the self-mobile device controls the self-mobile device to move along a preset working direction S by using a satellite navigation method until the self-mobile device completes a work task.
- the navigation method of the self-mobile device described above can adopt the method of alternating inertial navigation and satellite navigation when the satellite navigation signal cannot be received, thereby ensuring correct route when the mobile device works, improving navigation precision, and reducing navigation error.
- the sum of the preset time periods T and T1 is less than the time that the self-mobile device can maintain the inertial navigation high-precision positioning.
- the angle between the preset direction S1 and the working direction S includes, but is not limited to, 90 degrees.
- a self-mobile device for navigating by using the navigation method described above comprising a satellite navigation module and an inertial navigation module, further comprising:
- a detecting module configured to detect whether the satellite navigation module can receive stable satellite navigation signal
- a first control module configured to: when the detecting module detects that the satellite navigation module can receive a stable satellite navigation signal, use a satellite navigation module to control the self-mobile device to move along a preset working direction S, or When the detecting module detects that the satellite navigation module cannot receive a stable satellite navigation signal, the inertial navigation module controls the self-mobile device to move from the current position along the preset working direction S by a preset time period T, and Recording position coordinates of the mobile device after corresponding movement;
- a second control module configured to: when the detecting module detects that the satellite navigation module can receive a stable satellite navigation signal, use a satellite navigation module to control the self-mobile device to move along a preset working direction S, or When the detecting module detects that the satellite navigation module cannot receive the stable satellite navigation signal, the inertial navigation module controls the self-mobile device to move in the preset direction S1 for a preset time period T1, wherein the self-moving The device can receive a stable satellite navigation signal after moving the preset time period T1 along the preset direction S1;
- a third control module configured to control, by using a satellite navigation module, the positional coordinate of the self-moving device to return to the position of the self-moving device in a reverse direction of the preset direction S1 after the preset time period T is moved by the self-moving device along the preset working direction S ;
- the master control module is configured to control the working of the detecting module, the first control module, the second control module, and the third control module.
- the inertial navigation and the satellite navigation alternate manner can be adopted to ensure the correct route when the mobile device works, improve the navigation precision, and reduce the navigation error.
- the sum of the preset time periods T and T1 is less than the time that the self-mobile device can maintain the inertial navigation high-precision positioning.
- the angle between the preset direction S1 and the working direction S includes, but is not limited to, 90 degrees.
- the first control module includes:
- a first navigation unit configured to control, by using a satellite navigation module, the mobile device to move along a preset working direction S;
- a second navigation unit configured to control, by using an inertial navigation module, the self-moving device to move from a current position along a preset working direction S by a preset time period T;
- a recording unit configured to record position coordinates of the self-moving device after the corresponding movement and the self-shifting The posture of the moving device.
- the second control module includes:
- a first control unit configured to control, by using a satellite navigation module, the mobile device to move along a preset working direction S;
- the second control unit is configured to control, by the inertial navigation module, the self-moving device to move in the preset direction S1 for a preset time period T1.
- the present invention also provides a self-moving device walking control method, wherein the walking area of the mobile device includes a wireless signal dead zone and a wireless signal coverage area, and the method includes:
- Controlling when the time period in which the self-mobile device walks in the blind spot of the wireless signal exceeds a first time threshold, a time period during which the self-mobile device continues to walk for a first time threshold after retreating or steering;
- the self-mobile device shutdown alarm is controlled when the wireless signal blind zone is still in the dead zone of the wireless signal after the time when the mobile device retreats or turns to continue to walk for the first time threshold.
- the step of continuing to travel for a first time threshold after the steering is: controlling a time when the walking direction of the mobile device is rotated by an angle and then continuing to walk for a first time threshold, where the angle is between Between 0 and 180 degrees.
- the wireless signal coverage area includes a first wireless signal coverage area and a second wireless signal coverage area, and the strength of the wireless signal of the first wireless signal coverage area is higher than the second wireless signal coverage.
- the strength of the wireless signal of the zone; the method further comprises:
- the step of controlling the walking from the mobile device to the first wireless signal coverage area comprises:
- the method further includes:
- start timing When the calculated time from the mobile device last time in the second wireless signal coverage area does not exceed the third time threshold, start timing
- Controlling when the time period in which the self-mobile device walks in the blind spot of the wireless signal exceeds a fourth time threshold, a time period during which the self-mobile device continues to walk for a fifth time threshold; the fourth time threshold is less than the First time threshold;
- the self-mobile device shutdown alarm is controlled when the wireless signal blind zone is still in the wireless signal blind zone after the mobile device retreats or turns to continue walking for the fifth time threshold.
- a self-moving device walking control system wherein a walking area of the mobile device comprises a wireless signal blind zone and a wireless signal coverage zone, the system comprising:
- a controller configured to detect a walking area where the mobile device is located when walking
- timer being connected to the controller, the timer is configured to start timing when the self-mobile device is in the wireless signal dead zone;
- the steering device is connected to the controller, and the steering device is configured to control the self-mobile device to retreat or turn when the time when the self-mobile device walks in the blind spot of the wireless signal exceeds a first time threshold; And after the self-mobile device is backed up or turned, the controller is further configured to control a time when the self-mobile device continues to walk for a first time threshold;
- An alarm the alarm being connected to the controller, the alarm being configured to control the self when the wireless signal is in a dead zone after the time when the mobile device continues to walk for a first time threshold after retreating or turning The mobile device stops alarming.
- the steering gear comprises:
- An angle setting module configured to set a rotation angle of the self-moving device, and the angle is between 0 and 180 degrees;
- the steering module is respectively connected to the controller and the angle setting module, and the steering module is configured to control the control unit when the time when the self-mobile device walks in the blind spot of the wireless signal exceeds a first time threshold Said to move back or turn the angle from the mobile device.
- the wireless signal coverage area includes a first wireless signal coverage area and a second wireless signal coverage area, and the strength of the wireless signal of the first wireless signal coverage area is higher than the second wireless signal coverage. The strength of the wireless signal in the area;
- the timer is further configured to start timing when the self-mobile device is in the second wireless signal coverage area
- the redirector is further configured to control the self-mobile device to walk to the first wireless signal coverage area when the time that the self-mobile device walks in the second wireless signal coverage area exceeds a second time threshold.
- the controller is further configured to calculate that the self-mobile device is in the second wireless when the self-mobile device walks from the second wireless signal coverage area to the wireless signal dead zone The time of the signal coverage area;
- the timer is further configured to start timing when the calculated time when the self-mobile device is in the second wireless signal coverage area does not exceed a third time threshold;
- the redirector is further configured to control the self-mobile device to retreat or turn when the self-mobile device travels in the blind spot of the wireless signal exceeds a fourth time threshold, where the fourth time threshold is less than the first a time threshold; and after the self-mobile device is backed up or turned, the controller is further configured to control a time when the self-mobile device continues to walk for a fifth time threshold;
- the alarm is further configured to control the self-mobile device shutdown alarm when the wireless signal blind zone is still in the dead zone after the time when the mobile device continues to walk for a fifth time threshold after retreating or turning.
- the alarm is further configured to: when the calculated time from the mobile device last time in the second wireless signal coverage area exceeds the third time threshold and is less than the second time threshold The self-mobile device shutdown alarm is controlled.
- the self-mobile device walking control method and system can control the operation of the self-mobile device by determining whether the mobile device is in the wireless signal blind zone, so that the self-mobile device can be prevented when the wireless signal blind zone or the like has poor positioning accuracy.
- the mobile device enters the danger zone to prevent damage to the self-mobile device.
- FIG. 1 is a schematic diagram of an automatic working system according to an embodiment of the present invention.
- FIG. 2 is a schematic structural view of an automatic lawn mower according to an embodiment of the present invention.
- FIG. 3 is a schematic view showing the movement mode of the automatic lawn mower according to an embodiment of the present invention.
- FIG. 4 is a schematic diagram of an operation scenario of an automatic lawn mower according to another embodiment of the present invention.
- FIG. 5 is a flowchart of a navigation method of an automatic lawn mower according to another embodiment of the present invention.
- FIG. 6 is a flowchart of a method for controlling the walking of an automatic lawn mower according to another embodiment of the present invention.
- Figure 7 is a schematic view showing a walking area of an automatic lawn mower according to another embodiment of the present invention.
- FIG. 8 is a flowchart of a walking control method when an automatic mower is in a second wireless signal coverage area according to another embodiment of the present invention.
- FIG. 9 is a flowchart of a walking control method when an automatic lawn mower is in a second wireless signal coverage area according to still another embodiment of the present invention.
- FIG. 10 is a flowchart of a method for controlling the walking of an automatic lawn mower according to another embodiment of the present invention.
- FIG. 11 is a schematic structural view of an automatic lawn mower travel control system according to another embodiment of the present invention.
- the automated working system 100 includes self-mobile devices.
- the self-moving device is an automatic lawn mower 1.
- the self-mobile device may also be an unattended device such as an automatic cleaning device, an automatic watering device, an automatic snow sweeper, and the like.
- the automated working system 100 also includes a charging station 2 for the automatic lawn mower 1 to dock and replenish electrical energy.
- the automatic working system 100 includes a navigation module for outputting the current position of the automatic lawn mower.
- the navigation module includes a base station 17 and a mobile station 15.
- Both the base station 17 and the mobile station 15 receive satellite signals, and the base station 17 transmits a positioning correction signal to the mobile station 15 to implement differential satellite positioning.
- the base station 17 and the mobile station 15 receive the GPS positioning signal to implement DGPS positioning.
- base station 17 and mobile station 15 may also receive positioning signals such as Galileo satellite navigation systems, or Beidou satellite navigation systems, or GLONASS.
- the automatic working system is used to operate in a predetermined working area.
- the working area includes at least two sub-working areas separated from each other, and the sub-working areas are connected by the passage 400.
- a boundary 200 is formed between the work area and the non-work area, and the work area includes obstacles 9, 11 and the obstacle includes trees, pits and the like.
- the structure of the automatic mower 1 in this embodiment is as shown in FIG. 2.
- the automatic mower 1 includes a housing 3, a moving module, a task execution module, an energy module, a control module, and the like.
- the moving module comprises a crawler belt 5 driven by a driving motor to drive the automatic mower 1 to move.
- the task execution module includes a cutting assembly 7 that performs mowing work.
- the energy module includes a battery pack (not shown) that provides electrical energy for the movement and operation of the automatic mower 1.
- the control module is electrically connected to the mobile module, the task execution module and the energy module, and the control mobile module drives the automatic mower 1 to move, and controls the task execution module to perform work tasks.
- the automatic lawn mower includes a satellite navigation device, and is electrically connected to the control module to receive The satellite signal outputs the current position information of the automatic mower 1.
- the satellite navigation device includes the above-described mobile station 15.
- the quality of the position information output by the satellite navigation device varies with the working environment.
- the mobile station 15 can receive navigation signals of a plurality of satellites, and when the communication between the mobile station 15 and the base station 17 is not blocked, the quality of the position information output by the satellite navigation device is high. .
- the shaded area may be near the building, or blocked by trees, eaves, etc.
- the mobile station 15 can only receive navigation signals of a few satellites, or can not receive satellite navigation signals.
- the quality of the position information output by the satellite navigation device is reduced.
- the communication between the mobile station 15 and the base station 17 is blocked, and the quality of the location information output by the satellite navigation device is also reduced.
- the accuracy level of the positioning signal can be output.
- the automatic mower can also judge the current positioning state according to the position information output by the satellite navigation device, and output a positioning state indication.
- the basis for determining the quality of the position information output by the satellite navigation device may be the number of satellites that the satellite navigation device can receive the signal, or the positioning status indication, or the accuracy factor, or a plurality of factors, and setting the importance weight to obtain the position.
- Information quality The quality of the position information output by the satellite navigation device can be evaluated by the satellite navigation device itself, and the control module obtains the evaluation result, and can also be evaluated by the control module using the output of the satellite navigation device to obtain an evaluation result.
- the automatic mower further includes at least one position sensor electrically coupled to the control module to detect features associated with the position of the automatic mower.
- the position sensor may include a camera, a radar, a capacitive sensor, an inertial navigation sensor, and the like.
- the position sensor is an inertial navigation sensor, and the inertial navigation sensor may include an accelerometer, an odometer, a compass, a gyroscope, an attitude detection sensor, etc., detecting the speed, acceleration, and traveling direction of the mobile device.
- the control module determines the current position of the automatic lawn mower based at least in part on the output of the position sensor.
- the position information output by the satellite navigation device and the output of the position sensor may be combined to obtain the current position of the automatic mower.
- the inertial navigation sensor as an example, if the inertial navigation sensor is continuously used for navigation, the error of the output of the inertial navigation sensor will accumulate over time, resulting in a decrease in the accuracy of the output position information. Therefore, when the quality of the position information output by the satellite navigation device satisfies a preset condition, the output of the satellite navigation device is used to correct the output of the position sensor so that the position sensor can Maintain high precision output.
- the control module determines whether the quality of the location information output by the satellite navigation device at the current location meets the preset condition. If the preset condition is not met, the mobile module is controlled to drive the automatic mower to change the movement mode, so that after the movement The quality of the position information output by the satellite navigation device satisfies the preset condition.
- the automatic lawn mower includes a storage unit electrically connected to the control module and the satellite navigation device.
- the storage unit may be a storage unit integrated in the navigation module or a storage unit integrated in the control circuit of the automatic lawn mower.
- a position at which the quality of the position information output by the satellite navigation device satisfies a preset condition is referred to as a desired position, and the storage unit stores the desired position information.
- the control module controls the mobile module to drive the automatic mower to change the movement mode, and controls the movement module to drive the automatic mower to move to the desired position. That is to say, during the movement of the automatic mower, the satellite navigation device or the control module evaluates the quality of the position information output by the satellite navigation device at the position where the automatic mower moves, and records the quality of the position information output by the satellite navigation device.
- the location that satisfies the preset condition is usually the location at which the mobile station can receive a good satellite signal or base station signal.
- the control module determines the distance between the plurality of desired positions stored by the storage unit and the current position of the automatic lawn mower, and selects one of a plurality of desired positions according to the distance between the desired position and the current position of the automatic lawn mower to control the movement.
- the module drives the automatic mower to move to the selected desired position.
- the control module controls the mobile module to drive the automatic mower to move to a desired position closest to the current position of the automatic mower.
- the range of distances between the desired position and the current position of the automatic mower can also be set to control the automatic mower to move to a desired position that meets the range of distances. Controlling the automatic mower to move to a desired position closest to the distance or a desired position within a predetermined range can improve the working efficiency of the automatic mower and reduce energy consumption.
- the position where the quality of the position information output by the satellite navigation device does not satisfy the preset condition is referred to as the original position, and the storage unit stores the information of the original position.
- the control module controls the movement module to drive The automatic mower returns to its original position.
- the quality of the position information output by the satellite navigation device is improved, the automatic mower regains high-precision position information, and the output of the position sensor is also corrected. Therefore, when the automatic mower returns to the original position, it can maintain high-precision navigation, enabling the automatic mower to complete the cutting work in the shaded area, and solve the problem that the automatic mower cannot complete the cutting in the shaded area. It can be understood that the automatic mower moves to the original position, or does not return to a certain point before changing the movement mode, but only moves in the direction and returns to the area where the cutting is not completed.
- the control module controls the mobile module to drive the automatic mower to move along the preset path.
- the preset path may be a parallel reciprocating path, a spiral path, or the like.
- the control module determines that the position information output by the satellite navigation device does not satisfy the preset condition, the movement mode of the automatic lawn mower is changed. Specifically, the moving manner of the automatic mower can be referred to FIG. 3.
- the control module controls the movement module to drive the automatic mower to move along the parallel straight line.
- the control mobile module After the control module determines that the quality of the position information output by the satellite navigation device does not meet the preset condition, the control mobile module drives the automatic mower to continue moving along the parallel line for a preset time or a preset distance, at the preset time or the preset distance. Internally, the inertial navigation sensor has a small output error, and the automatic mower can maintain navigation with higher precision. After the automatic mower moves the preset time or the preset distance, the control module controls the mobile module to drive the automatic mower to move to the first desired position, and the first desired position is the desired position recorded by the storage unit, and the distance automatic mower The current location is the closest desired location.
- the satellite navigation signal of the automatic mower is good, and the satellite navigation signal is used to correct the error of the output of the inertial navigation sensor, so that the output of the inertial navigation sensor is restored with high precision.
- the automatic mower returns to its original position and continues to move along the preset parallel straight path, continuing to perform mowing in the shaded area.
- the automatic mower will change the movement mode after moving the preset time or the preset distance, and repeat the above steps. Until the automatic mower leaves the shadow area.
- the automatic mower when the automatic mower moves to an area where the satellite navigation signal is poor, the automatic mower can still maintain high-precision navigation by changing the movement mode, and can complete the cutting of the area where the satellite navigation signal is poor. This enables the automatic mower to cut the entire work area with high efficiency.
- the preset condition that the quality of the position information output by the satellite navigation device needs to be satisfied may be based on the number of satellites that the satellite navigation device can receive the signal, or the positioning status indication, or the accuracy factor, or more, as described above.
- the combination of factors determines, for example, the preset condition may be that the number of satellites that the satellite navigation device receives the signal is greater than or equal to four, and the like.
- FIG. 3 is only a schematic diagram of the movement mode of the automatic lawn mower of the embodiment, and the specific path of the automatic lawn mower changing the movement mode can be flexibly selected. After the automatic mower moves to the desired position, it may not return to the original position immediately, but return to the uncut shadow area after completing the cutting of the entire working area or part of the working area. After the automatic mower walks to the desired position, it can continue to move along the uncovered preset path or re-plan the path.
- FIG. 4 when the automatic lawn mower 1 walks along an obstacle such as a fence/tree/flower, the obstacles such as fences/trees/flowers are shown in the dotted line in FIG. The shadow formed), because the occlusion will cause poor GPS signal, if you continue to use GPS navigation, it basically belongs to the "blind guide", which will cause a large error. If the automatic mower stops working, wait for the GPS signal to change. After the strong mowing task, the efficiency is significantly reduced.
- the automatic mower can also use its own inertial navigation system for navigation, but according to the working principle of the inertial navigation system (the working principle of inertial navigation is based on Newton's laws of mechanics, by measuring the carrier in inertia The acceleration of the reference frame, integrating it with time, and transforming it into the navigation coordinate system, can get the information of speed, yaw angle and position in the navigation coordinate system.) It can be seen that the inertial navigation system belongs to the estimated navigation. In the way, with the extension of time, the accuracy will be reduced, which is not conducive to the long-term work of the automatic mower.
- the navigation method of the self-mobile device of an embodiment includes steps S110 to S160.
- Step S110 detecting whether the mobile satellite device can receive a stable satellite navigation signal, if the mobile device can receive a stable satellite navigation signal, then proceeds to step S160;
- Step S120 If the mobile device cannot receive the stable satellite navigation signal, the self-mobile device moves the preset time period T from the current position along the preset working direction S by using the inertial navigation mode, and records the corresponding movement after the mobile device moves. Position coordinates;
- Step S130 detecting whether the mobile satellite device can receive a stable satellite navigation signal, if the mobile device can receive a stable satellite navigation signal, then proceeds to step S160;
- Step S140 if the stationary satellite navigation signal is not received from the mobile device, the self-mobile device moves in the preset direction S1 from the position coordinate of the self-moving device after moving the preset time period T in the working direction S by using the inertial navigation mode. a time period T1, wherein the stable satellite navigation signal can be received after the mobile device moves in the preset direction S1 for a preset time period T1;
- step S150 the satellite navigation mode is used to control the positional coordinates of the self-mobile device in the reverse direction of the preset direction S1 to be moved from the mobile device in the preset working direction S by the preset time period T, and the self-mobile device moves.
- the front and rear postures are the same, and proceeds to step S120;
- Step S160 The mobile device controls the self-mobile device to move along the preset working direction S by using a satellite navigation method until the self-mobile device completes the work task.
- the above navigation method of the mobile device can adopt the method of inertial navigation and satellite navigation alternately when the satellite navigation signal cannot be received, thereby ensuring the correct route when the mobile device works, improving the navigation precision, and reducing the navigation error.
- the time period T of the mobile device moving along the preset working direction S is too long, the path error of the self-mobile device may be too large, so the time period T should be limited to Within a certain range.
- the time period T1 of the mobile device moving in the preset direction S1 is too long, since the preset direction S1 is not the working direction, it is only for correcting the path error, and therefore, the time period T1 should also be limited to a certain range. The greatest possible correction of navigation errors while minimizing energy consumption from mobile devices.
- the sum of its corresponding movement time T and T1 should be less than the time when the self-mobile device can maintain the high-precision positioning of the inertial navigation, so as to fully ensure that the inertial navigation along the S and the self-mobile device The accuracy of S1 movement.
- the angle between the preset direction S1 and the working direction S includes but is not limited to 90 degrees.
- the time period T1 can be preset to the minimum time to improve the working efficiency of the mobile device.
- the mobile device moves in the preset direction S1
- the area in which the mobile device is located is different, and the different regions can receive satellite signals. Therefore, the mobile device can receive when moving in different directions along the direction S1.
- the time to a stable satellite navigation signal is also different, that is, self-moving
- the time period T1 in which the device moves in the direction S1 may be different in different areas, such as 5 seconds, 6 seconds, 10 seconds, etc., but the time period T1 should be that the satellite navigation can be received when the mobile device moves in the preset direction S1.
- the minimum time of the signal is also different, that is, self-moving
- Self-mobile devices can be a variety of devices, especially automatic lawn mowers.
- the schematic diagram of the automatic mower working according to the above navigation method is shown in Fig. 3.
- the inertial navigation mode is used to move the time period T to A along the working direction S, as in the A.
- Receiving the satellite navigation signal moving the time period T1 to B along the preset direction S1 (where the automatic lawn mower can receive the stable satellite navigation signal at point B), and the automatic lawn mower returns from point B to point A; After that, the automatic mower moves from the point A in the working direction S to the time period T to C.
- the time period T1 to D is moved in the preset direction S1 (where the automatic lawn mower The stable satellite navigation signal can be received at point D), and the automatic mower returns from point D to point C; after that, the automatic lawn mower moves from point C in the working direction S to the time point T to point E, as at point E.
- the time period T1 to point F will be moved in the preset direction S1 (where the automatic lawn mower can receive a stable satellite navigation signal at point F), and the automatic mower returns from point F to point E. point. This cycle, until the automatic mower can receive a stable satellite navigation signal, moves in satellite navigation until the task is completed.
- the embodiment also provides a self-mobile device that uses the above navigation method for navigation, including a satellite navigation module and an inertial navigation module, and further includes:
- a detection module for detecting whether the satellite navigation module can receive a stable satellite navigation signal
- a first control module configured to: when the detecting module detects that the satellite navigation module can receive a stable satellite navigation signal, use a satellite navigation module to control movement of the self-moving device along a preset working direction S, or detect satellite navigation in the detecting module
- the inertial navigation module is used to control the self-moving device to move from the current position along the preset working direction S for a preset time period T, and record the position coordinates after the corresponding movement of the mobile device;
- a second control module configured to: when the detecting module detects that the satellite navigation module can receive the stable satellite navigation signal, use the satellite navigation module to control the movement from the mobile device along the preset working direction S, or detect the satellite navigation in the detecting module
- the inertial navigation module is used to control the self-moving device to move in the preset direction S1 for a preset time period T1, wherein the mobile device moves the preset time period T1 along the preset direction S1.
- a third control module configured to use the satellite navigation module to control the positional coordinates of the self-moving device returning in a reverse direction of the preset direction S1 to the self-moving device after moving the preset time period T along the preset working direction S;
- the master control module is configured to control the detection module, the first control module, the second control module, and the third control module to work.
- the above navigation method of the mobile device can adopt the method of inertial navigation and satellite navigation alternately when the satellite navigation signal cannot be received, thereby ensuring the correct route when the mobile device works, improving the navigation precision, and reducing the navigation error.
- the time period T of the mobile device moving along the preset working direction S is too long, the path error from the mobile device may be too large, so the time period T should be limited. Within a certain range.
- the time period T1 of the mobile device moving in the preset direction S1 is too long, since the preset direction S1 is not the working direction, it is only for correcting the path error, and therefore, the time period T1 should also be limited to a certain range. The greatest possible correction of navigation errors while minimizing energy consumption from mobile devices. To this end, the sum of the preset time periods T and T1 is less than the time during which the self-mobile device can maintain the high-precision positioning of the inertial navigation.
- the angle between the preset direction S1 and the working direction S includes but is not limited to 90 degrees.
- the time period T1 can be preset to the minimum time to improve the working efficiency of the mobile device.
- the first control module includes:
- a first navigation unit configured to use a satellite navigation module to control movement from the mobile device along a preset working direction S;
- a second navigation unit configured to use the inertial navigation module to control the movement of the preset time period T from the current position along the preset working direction S by the mobile device;
- the recording unit is configured to record the position coordinates of the mobile device after the corresponding movement and the posture of the self-mobile device.
- the second control module includes:
- a first control unit configured to use a satellite navigation module to control movement from the mobile device along a preset working direction S;
- the second control unit is configured to control, by the inertial navigation module, to move the preset time period T1 from the mobile device in the preset direction S1.
- FIG. 6 is a flowchart of a mobile device walking control method.
- a walking area of the self-mobile device includes a wireless signal blind zone and a wireless signal coverage area.
- the method includes:
- the mobile station Since the positioning accuracy of the DGPS of the mobile station is improved by communication with the base station, that is, the mobile station needs to receive the pseudorange correction value sent by the base station in real time, but in practical applications, due to the occlusion of obstacles such as houses, the base station and the base station The communication of the mobile station may result in a dead zone or a poor signal area, thus affecting the precise positioning of the mobile station. Therefore, in this embodiment, the walking area where the mobile device is located is first determined, and if it is in the blind spot of the wireless signal, the corresponding control strategy is adopted to ensure that the self-mobile device does not enter the dangerous area, thereby preventing the self-mobile device from being damage.
- S104 Start timing when the mobile device is in a wireless signal dead zone.
- control continues to travel from the mobile device, and may generally be controlled to continue walking from the mobile device according to a pre-planned path, or may control the walking of the mobile device through a certain control strategy.
- S106 Determine whether the time that the mobile device walks in the blind spot of the wireless signal exceeds a first time threshold.
- the self-mobile device when the mobile device enters the wireless signal dead zone, the self-mobile device continues to travel according to the pre-planned path. If the mobile device walks out of the wireless signal blind zone within the first time threshold, When the mobile device walks to the wireless signal coverage area, the mobile device continues to follow the pre-planned path. If the mobile device is still in the wireless signal blind zone within the first time threshold, then if the mobile device continues in the pre-planned path, Walking, the self-moving device may walk to a dangerous area, so it is necessary to control the walking of the self-moving device, as described below.
- the first time threshold may be preset according to the width and length of the wireless signal dead zone, for example, may be 5 seconds, 10 seconds, 15 seconds, 18 seconds, 20 seconds, etc., but in general, the first time threshold Less than or equal to 10 seconds.
- step S108 When the time when the mobile device walks in the blind spot of the wireless signal exceeds the first time threshold, control the time when the mobile device retreats or turns to continue to travel for the first time threshold. Otherwise, return to step S106 to determine that the mobile device is in the wireless signal. Whether the time of walking in the blind spot exceeds the first time threshold.
- the self-moving device can also be controlled to turn, for example, to control the walking direction of the mobile device to rotate after an angle and continue to walk for the first time.
- the time of the threshold, the angle is between 0 and 180 degrees.
- S111 Determine whether the wireless signal dead zone is still after the time when the mobile device moves back or turns to continue the first time threshold.
- step S112 When the wireless signal dead zone is still in the wireless signal dead zone after the mobile device retreats or turns to the first time threshold, the self-mobile device shutdown alarm is controlled. Otherwise, the process returns to step S102 to determine whether the self-mobile device is in the wireless signal blind zone.
- the self-mobile device shutdown alarm is controlled, and may be performed by a device such as a buzzer, or the information of the self-mobile device in the blind spot of the wireless signal may be sent back to the background.
- the self-mobile device walking control method controls the operation of the self-mobile device by determining whether the mobile device is in a wireless signal blind zone, so that the self-mobile device can prevent the self-mobile device when the wireless signal blind zone or the like has poor positioning accuracy. Walk into the danger zone to prevent damage from the mobile device.
- FIG. 7 is a schematic diagram of a walking area of a self-moving device in an embodiment.
- the wireless signal coverage area includes a first wireless signal coverage area and a second wireless signal coverage area, and the strength of the wireless signal of the first wireless signal coverage area is higher than the strength of the wireless signal of the second wireless signal coverage area;
- the first wireless signal coverage area refers to a region with a good wireless signal
- the second wireless signal coverage area refers to a region with a poor wireless signal.
- the self-mobile device can acquire a base station.
- the transmitted PRC signal but the signal strength of the PRC signal is poor and the interference is high.
- FIG. 8 is a flowchart of a walking control method when the mobile device is in the second wireless signal coverage area in an embodiment. In the real In the example, the method includes:
- S302 Detect the walking area where the mobile device is located while walking.
- the wireless signal coverage area is divided into a first wireless signal coverage area and a second wireless signal coverage area, and the precise positioning of the self-mobile device can be implemented in the first wireless signal coverage area, and the mobile device follows the pre-planning.
- the path continues to walk, but if the self-mobile device is in the second wireless signal coverage area, the signal from the mobile station received by the mobile station on the mobile device is more interfered, so that the positioning from the mobile device is no longer accurate, and thus Continued walking from the mobile device may cause it to enter a dangerous area, so it is necessary to control the walking from the mobile device, as described below.
- S304 Start timing when the mobile device is in the second wireless signal coverage area.
- the size of the second time threshold may be set according to the length and width of the second wireless signal coverage area, and may be 10 seconds, 15 seconds, 22 seconds, 25 seconds, 28 seconds, 30 seconds, 35 seconds, etc.
- the second time threshold is less than or equal to 30 seconds, and the second time threshold is generally greater than the first time threshold.
- S306 Determine whether the time that the mobile device walks in the second wireless signal coverage area exceeds a second time threshold.
- step S308 When the time when the mobile device is in the second wireless signal coverage area exceeds the second time threshold, the control moves from the mobile device to the first wireless signal coverage area. Otherwise, the process returns to step S306 to determine that the self-mobile device is in the second wireless. Whether the time the signal coverage area travels exceeds the second time threshold.
- the self-mobile device can obtain the current location of the mobile device and the first wireless signal coverage area.
- the relative direction, so that the self-mobile device can walk toward the first wireless signal coverage area according to the relative direction, so the step of controlling the walking from the mobile device to the first wireless signal coverage area may include: acquiring the current location of the mobile device and the first a relative direction of the wireless signal coverage area; controlling the walking from the mobile device to the first wireless signal coverage area according to the relative direction.
- the self-mobile device when the mobile device walks from the second wireless signal coverage area to the first wireless signal coverage area within a second time threshold time, the self-mobile device continues to walk according to the pre-planned path.
- the self-mobile device cannot obtain its own precise positioning when the mobile device walks from the second wireless signal coverage area to the wireless signal dead zone within the second time threshold time, please refer to FIG. 9 is the first self-mobile device in the other embodiment A flow chart of the walking control method when the wireless signal coverage area is used.
- the method further includes:
- S402 Determine whether the mobile device walks from the second wireless signal coverage area to the wireless signal blind zone.
- step S404 When the mobile device walks from the second wireless signal coverage area to the wireless signal blind zone, calculate the time when the mobile device is in the second wireless signal coverage area last time. Otherwise, proceed to step S420 to determine whether the self-mobile device is from the second.
- the wireless signal coverage area travels to the first wireless signal coverage area.
- the self-mobile device Since the self-mobile device walks from the second wireless signal coverage area to the wireless signal blind area, since the self-mobile device cannot accurately perform positioning in the second wireless signal coverage area, if the time is further walked to the wireless signal dead zone If the time is long, the time that the mobile device cannot be accurately positioned is too long, which may cause the self-mobile device to travel to the dangerous area. Therefore, it is necessary to calculate the time that the self-mobile device walks in the second wireless signal coverage area, according to the time. To determine the threshold of the walking time of the mobile device in the blind spot of the wireless signal.
- the third time threshold may be 5 seconds, 6 seconds, 8 seconds, 10 seconds, 12 seconds, 15 seconds, 18 seconds, etc., usually the third time threshold is generally less than or equal to 10 seconds, and the third time threshold Less than the second time threshold.
- step S408 When the calculated time from the mobile device last time in the second wireless signal coverage area does not exceed the third time threshold, start timing, otherwise, proceed to step S418: control the self-mobile device shutdown alarm.
- S410 Determine whether the time that the mobile device walks in the blind spot of the wireless signal exceeds a fourth time threshold.
- the fourth time threshold is determined according to the time when the mobile device was last in the second wireless signal coverage area, and the fourth time threshold may be 5 seconds, 7 seconds, 9 seconds, 12 seconds, 15 seconds, 18 Seconds, etc., and generally the fourth time threshold is less than 10 seconds, and the fourth time threshold is less than the first time threshold.
- S412 Control the time for the fifth time threshold to continue to travel after the mobile device retreats or turns after the time when the mobile device walks in the blind spot of the wireless signal exceeds the fourth time threshold.
- the fifth time threshold may be 5 seconds, 7 seconds, 9 seconds, 12 seconds, 15 seconds, 18 seconds, etc., and is generally fifth.
- the time threshold is typically 10 seconds and the fifth time threshold is equal to or greater than the fourth time threshold.
- S414 Determine whether the wireless signal dead zone is still in time after the time when the mobile device moves back or turns to continue the fifth time threshold.
- S416 Control the self-mobile device shutdown alarm when the wireless signal dead zone is still in the wireless signal dead zone after the mobile device retreats or turns to continue to walk for the fifth time threshold.
- S420 Determine whether the mobile device walks from the second wireless signal coverage area to the first wireless signal coverage area.
- step S422 When the mobile device walks from the second wireless signal coverage area to the first wireless signal coverage area, then controls the mobile device to follow the pre-planned path, otherwise returns to step S306 to continue to determine that the self-mobile device is in the second wireless signal. Whether the time the coverage area travels exceeds the second time threshold.
- the self-mobile device shutdown alarm is controlled, and may be performed by a device such as a buzzer, or the information of the self-mobile device in the blind spot of the wireless signal may be sent back to the background.
- the self-mobile device shutdown alarm is controlled when the calculated time since the last time the mobile device was in the second wireless signal coverage area exceeds the third time threshold and is less than the second time threshold.
- FIG. 10 is a flowchart of the self-mobile device walking control method in another embodiment. . In this embodiment, it is first controlled to start walking from the mobile device.
- control moves from the mobile device according to a pre-planned path.
- the control moves from the mobile device according to the pre-planned path and starts timing. If the time of walking in the blind spot of the wireless signal exceeds the first threshold time, the mobile device is controlled to move backward or backward. The time when the first time threshold is continued to run, if the self-mobile device is still in the blind spot of the wireless signal after the time of the first time threshold is completed, the alarm is stopped.
- the self-mobile device is located in the second wireless signal coverage area, controlling the self-mobile device to walk according to a pre-planned path and start timing, if walking in the second wireless signal coverage area
- the control moves from the mobile device to the first wireless signal coverage area. If the time of walking in the coverage area of the second wireless signal does not exceed the second time threshold, then control to continue walking from the mobile device, and determine whether the self-mobile device walks to the blind spot of the wireless signal, and if walking to the blind spot of the wireless signal, calculate The time when the second wireless signal coverage area was last, and whether the time of the second wireless signal coverage area last time exceeds the third time threshold. If the third time threshold is not exceeded, the self-mobile device is controlled according to the pre-planned path.
- FIG. 11 is a schematic structural diagram of a walking control system of a mobile device according to an embodiment.
- a walking area of the mobile device includes a wireless signal blind zone and a wireless signal coverage zone, and the system may be Includes controllers, timers, steering gear, and alarms.
- the timer is coupled to a controller that is coupled to a controller that is coupled to the controller.
- the controller is configured to detect whether the wireless signal is in a dead zone when the mobile device is walking; the timer is used to start timing when the mobile device is in the wireless signal blind zone; the redirector is used when the mobile device walks in the wireless signal blind zone for more than the time At a time threshold, the control is backed up or turned from the mobile device; and after the mobile device is backed up or turned, the controller is further configured to control the time from when the mobile device continues to walk for the first time threshold; the alarm is used to retreat from the mobile device or After the time after the steering continues to walk for the first time threshold, the radio signal is stopped and the alarm is stopped.
- the diverter may include: an angle setting module for setting a rotation angle of the self-moving device, and an angle between 0 and 180 degrees; a steering module, the steering module and the controller and the angle setting respectively The modules are connected, and the steering module is configured to control the back or steering angle of the self-moving device when the time that the mobile device walks in the blind spot of the wireless signal exceeds the first time threshold.
- the wireless signal coverage area includes a first wireless signal coverage area and a second wireless signal coverage area, and the strength of the wireless signal of the first wireless signal coverage area is higher than the strength of the wireless signal of the second wireless signal coverage area.
- the controller is further configured to detect the second wireless signal coverage area where the mobile device is located while walking; the timer is further configured to start timing when the mobile device is in the second wireless signal coverage area; the steering device is also used to The time since the mobile device walked in the second wireless signal coverage area exceeded When the second time threshold is exceeded, the control moves from the mobile device to the first wireless signal coverage area.
- the values of the first time threshold and the second time threshold may be referred to above. Generally, the first time threshold is less than or equal to 10 seconds, and the second time threshold is less than or equal to 30 seconds.
- the controller is further configured to calculate a time when the mobile device is in the second wireless signal coverage area when the mobile device walks from the second wireless signal coverage area to the wireless signal coverage area; the timer is further used to The timing is started when the time when the mobile device is in the second wireless signal coverage area does not exceed the third time threshold; the redirector is further configured to control when the time when the mobile device walks in the wireless signal blind zone exceeds the fourth time threshold The mobile device retreats or turns, the fourth time threshold is less than the first time threshold; and after the mobile device is backed up or turned, the controller is further configured to control the time when the timer drives the mobile device to continue to walk for the fifth time threshold; the alarm is further It is used to control the self-mobile device shutdown alarm when the wireless signal dead zone is still in the dead zone of the wireless signal after the time when the mobile device continues to walk or turn to the fifth time threshold.
- the alarm is further configured to control the self-mobile device shutdown alarm when the calculated time since the last time the mobile device was in the second wireless signal coverage area exceeds the third time threshold and is less than the second time threshold.
- the ranges of the third time threshold, the fourth time threshold, and the fifth time threshold may be referred to above.
- the third time threshold is less than or equal to 10 seconds
- the fourth time threshold is less than 10 seconds.
- the time threshold is equal to 10 seconds.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Business, Economics & Management (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Health & Medical Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
一种自移动设备(1),包括:移动模块、任务执行模块和控制模块;控制模块与移动模块、任务执行模块电连接,控制移动模块带动自移动设备(1)移动,并控制任务执行模块执行工作任务;自移动设备(1)还包括卫星导航装置(15),与控制模块电连接,接收卫星信号,输出自移动设备(1)的当前位置信息;控制模块判断当前位置卫星导航装置(15)输出的位置信息的质量是否满足预设条件,若不满足预设条件,则控制移动模块带动自移动设备(1)改变移动方式,以使得在移动后的位置卫星导航装置(15)输出的位置信息的质量满足预设条件。自移动设备(1)的有益效果是:自移动设备(1)移动至卫星导航信号差的区域时,通过改变移动方式,使得自移动设备(1)能够保持高精度导航。
Description
本发明涉及一种自动工作系统,自移动设备及其控制方法。
随着科学技术的发展,自移动设备为人们所熟知,由于自移动设备可以按照自动预先设置的程序执行预先设置的相关任务,无须人为的操作与干预,因此在工业及家居产品上的应用非常广泛。工业上的应用如执行各种功能的机器人,家居产品上的应用如割草机、吸尘器等,这些自移动设备极大地节省了人们的时间,给工业生产及家居生活都带来了极大的便利。
自动割草机是最常用的一种家用产品,可以用来自动地执行割草任务,修剪草坪,保持草坪的整洁与秀美。自动割草机在执行割草任务时通常采用GPS导航(包括DGPS导航),随着以后北斗系统的成熟,也可能会采用北斗信号导航。但如图1中所示,当自动割草机沿着栅栏/树木/花丛等障碍物旁行走时(图1中虚线部分为栅栏/树木/花丛等障碍物形成的阴影),由于遮挡会造成GPS信号较差,此时如果继续使用GPS导航,基本上属于“盲导”,会造成较大的误差,如果让自动割草机停止工作,在原地通过长时间解算得到精确坐标,则会使解算软硬件复杂,设备成本增加。同时,设备在某段时间内停止不动,会给用户造成设备故障的错觉,不利于设备的推广及普及。在这种情况下,自动割草机也可以采用自身携带的惯性导航系统进行导航工作,但根据惯性导航系统的工作原理(惯性导航的工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,且把它变换到导航坐标系中,就能够得到在导航坐标系中的速度、偏航角和位置等信息。)可知,惯性导航系统属于推算导航方式,随着时间的延长,精度必然降低,并不利于自动割草机长时间的工作。
DGPS(difference global positioning system,差分全球定位系统)是在一个精确的已知位置上安装监测接收机,计算得到它能跟踪的每颗GPS卫星的距离误差。该差值通常称为PRC(伪距离修正值),将此PRC传送给用户接收机作误差修正,从而提高了定位精度。目前,DGPS的基站和移动站需要共同接收至少4颗卫星,才能使用RTK((Real-time kinematic,实时动态差
分)算法,实现精确定位,当存在房屋等障碍物遮挡时,基站和移动站之间不能共同接收至少4颗卫星时,出现盲区无法精确定位。
传统上,自移动设备上设置有DGPS的移动站接收天线,DGPS的基站的无线信号发射天线一般设置在自移动设备的充电站上,但是由于充电站的高度较低,无线电波传输过程中会遇到房屋等障碍物而导致信号衰减,特别是当自移动设备行驶到障碍物旁边时,DGPS基站基本上不能与该自移动设备上的接收站进行数据通信,因此DGPS的定位精度大大降低。
当DGPS的定位精度大大降低时,即自移动设备行驶到障碍物旁边或者信号盲区时,自移动设备无法准确知道自身所在的位置,因此在没有边界线的情况下,该自移动设备可能会行驶至危险的区域,从而导致该自移动设备的损坏。
发明内容
为克服现有技术的缺陷,本发明提供:
一种自移动设备,包括:移动模块、任务执行模块和控制模块;所述控制模块与移动模块、任务执行模块电连接,控制移动模块带动自移动设备移动,并控制任务执行模块执行工作任务;所述自移动设备还包括卫星导航装置,与控制模块电连接,接收卫星信号,输出自移动设备的当前位置信息;所述控制模块判断当前位置所述卫星导航装置输出的位置信息的质量是否满足预设条件,若不满足预设条件,则控制所述移动模块带动自移动设备改变移动方式,以使得在移动后的位置所述卫星导航装置输出的位置信息的质量满足预设条件。
优选的,所述自移动设备包括存储单元,与控制模块及卫星导航装置电连接;将卫星导航装置输出的位置信息的质量满足预设条件的位置称为期望位置;所述存储单元存储期望位置信息;所述控制模块控制移动模块带动自移动设备改变移动方式包括,控制所述移动模块带动自移动设备向所述期望位置移动。
优选的,所述控制模块判断所述存储单元存储的若干期望位置与自移动设备的当前位置的距离,根据期望位置与自移动设备的当前位置的距离选择若干期望位置的其中之一,控制移动模块带动自移动设备向被选择的期望位置移动。
优选的,所述控制模块控制移动模块带动自移动设备向距离自移动设备的当前位置最近的期望位置移动。
优选的,将自移动设备改变移动方式之前,所在的所述卫星导航装置输出的位置信息的质量不满足预设条件的位置称为原始位置,所述存储单元存储所述原始位置的信息;所述自移动设备移动至期望位置后,所述控制模块控制所述移动模块带动自移动设备返回所述原始位置。
优选的,所述控制模块控制所述移动模块带动自移动设备改变移动方式之前,所述控制模块控制所述移动模块带动自移动设备沿预设路径移动;所述控制模块控制所述移动模块带动自移动设备返回所述原始位置后,控制所述移动模块带动自移动设备继续沿预设路径移动。
优选的,所述控制模块控制所述移动模块带动自移动设备改变移动方式之前,所述控制模块控制所述移动模块带动自移动设备沿预设路径移动;所述控制模块在判断当前位置所述卫星导航装置输出的位置信息的质量不满足预设条件后,控制移动模块带动自移动设备沿预设路径继续移动预设时间或预设距离,再改变移动方式。
优选的,所述自移动设备还包括至少一个位置传感器,与控制模块电连接,检测与自移动设备的位置相关的特征;当卫星导航装置输出的位置信息的质量不满足预设条件时,所述控制模块至少部分的基于所述位置传感器的输出判断所述自移动设备的当前位置。
优选的,所述位置传感器包括摄像头,雷达,电容传感器,惯性导航传感器的至少其中之一。
优选的,当所述卫星导航装置输出的位置信息的质量满足预设条件时,所述自移动设备利用所述卫星导航装置的输出来校正所述位置传感器的输出。
优选的,所述预设条件包括,卫星导航装置接收到信号的卫星个数大于等于预设值。
本发明还提供一种自动工作系统,包括前述任一项所述的自移动设备。
本发明还提供一种自移动设备的控制方法,所述自移动设备包括卫星导航装置,接收卫星信号,输出自移动设备的当前位置信息;所述自移动设备的控制方法包括步骤:判断当前位置所述卫星导航装置输出的位置信息的质量是否满足预设条件;若不满足预设条件,则控制自移动设备改变移动方式,
以使得在移动后的位置所述卫星导航装置输出的位置信息的质量满足预设条件。
优选的,将卫星导航装置输出的位置信息的质量满足预设条件的位置称为期望位置;存储期望位置信息;改变移动方式包括步骤,控制所述自移动设备向所述期望位置移动。
优选的,判断存储的若干期望位置与自移动设备的当前位置的距离,根据期望位置与自移动设备的当前位置的距离选择若干期望位置的其中之一,控制自移动设备向被选择的期望位置移动。
优选的,控制自移动设备向距离自移动设备的当前位置最近的期望位置移动。
优选的,将自移动设备改变移动方式之前,所在的所述卫星导航装置输出的位置信息的质量不满足预设条件的位置称为原始位置,存储所述原始位置;控制自移动设备移动至期望位置后,再控制自移动设备返回所述原始位置。
优选的,自移动设备改变移动方式之前,控制自移动设备沿预设路径移动;自移动设备返回所述原始位置后,控制自移动设备继续沿预设路径移动。
优选的,自移动设备改变移动方式之前,控制自移动设备沿预设路径移动;判断当前位置所述卫星导航装置输出的位置信息的质量不满足预设条件后,控制自移动设备沿预设路径继续移动预设时间或预设距离,再改变移动方式。
优选的,所述自移动设备还包括至少一个位置传感器,检测与自移动设备的位置相关的特征;当卫星导航装置输出的位置信息的质量不满足预设条件时,至少部分的基于所述位置传感器的输出判断所述自移动设备的当前位置。
优选的,所述位置传感器包括摄像头,雷达,电容传感器,惯性导航传感器的至少其中之一。
优选的,当所述卫星导航装置输出的位置信息的质量满足预设条件时,利用所述卫星导航装置的输出来校正所述位置传感器的输出。
优选的,所述预设条件包括,卫星导航装置接收到信号的卫星个数大于等于预设值。
与现有技术相比,本发明的有益效果是:自移动设备移动至卫星导航信
号差的区域时,通过改变移动方式,使得自移动设备能够保持高精度导航,且能够完成对卫星导航信号差的区域的覆盖,使得自移动设备能够高效率的完成对整个工作区域的覆盖。
本发明还提供一种自移动设备的导航方法,包括:
(1)检测自移动设备是否可以接收到稳定的卫星导航信号;
(2)若所述自移动设备可以接收到稳定的卫星导航信号,则进入步骤(8);
(3)所述自移动设备采用惯性导航方式从当前位置沿预设的工作方向S移动预设的时间段T,并记录所述自移动设备对应移动后的位置坐标;
(4)检测自移动设备是否可以接收到稳定的卫星导航信号;
(5)若所述自移动设备可以接收到稳定的卫星导航信号,则进入步骤(8);
(6)所述自移动设备采用惯性导航方式从所述自移动设备沿工作方向S移动预设的时间段T后的位置坐标处沿预设方向S1移动预设的时间段T1,其中,所述自移动设备沿所述预设方向S1移动预设的时间段T1后能够接收到稳定的卫星导航信号;
(7)采用卫星导航方式控制所述自移动设备沿预设方向S1的反方向返回至所述自移动设备沿预设的工作方向S移动预设的时间段T后的位置坐标,且所述自移动设备移动前后姿态相同,并进入步骤(3);
(8)所述自移动设备采用卫星导航方式控制所述自移动设备沿预设的工作方向S移动,直至所述自移动设备完成工作任务。
以上所述自移动设备的导航方法,在无法接收到卫星导航信号时,可以采用惯性导航与卫星导航交替的方式,保证自移动设备工作时的路线正确,提高导航精度,减小导航误差。
在其中一个实施例中,所述预设的时间段T与T1之和小于所述自移动设备可保持惯性导航高精度定位的时间。
在其中一个实施例中,所述预设方向S1与所述工作方向S之间的夹角包括但不限于90度。
一种采用以上所述导航方法进行导航的自移动设备,包括卫星导航模块和惯性导航模块,还包括:
检测模块,用于检测所述卫星导航模块是否可以接收到稳定的卫星导航
信号;
第一控制模块,用于在所述检测模块检测到所述卫星导航模块可以接收到稳定的卫星导航信号时,采用卫星导航模块控制所述自移动设备沿预设的工作方向S移动,或者在所述检测模块检测到所述卫星导航模块不能接收到稳定的卫星导航信号时,采用惯性导航模块控制所述自移动设备从当前位置沿预设的工作方向S移动预设的时间段T,并记录所述自移动设备对应移动后的位置坐标;
第二控制模块,用于在所述检测模块检测到所述卫星导航模块可以接收到稳定的卫星导航信号时,采用卫星导航模块控制所述自移动设备沿预设的工作方向S移动,或者在所述检测模块检测到所述卫星导航模块不能接收到稳定的卫星导航信号时,采用惯性导航模块控制所述自移动设备沿预设方向S1移动预设的时间段T1,其中,所述自移动设备沿所述预设方向S1移动预设的时间段T1后能够接收到稳定的卫星导航信号;
第三控制模块,用于采用卫星导航模块控制所述自移动设备沿预设方向S1的反方向返回至所述自移动设备沿预设的工作方向S移动预设的时间段T后的位置坐标;
总控模块,用于控制所述检测模块、第一控制模块、第二控制模块及第三控制模块工作。
以上所述自移动设备,在无法接收到卫星导航信号时,可以采用惯性导航与卫星导航交替的方式,保证自移动设备工作时的路线正确,提高导航精度,减小导航误差。
在其中一个实施例中,所述预设的时间段T与T1之和小于所述自移动设备可保持惯性导航高精度定位的时间。
在其中一个实施例中,所述预设方向S1与所述工作方向S之间的夹角包括但不限于90度。
在其中一个实施例中,所述第一控制模块包括:
第一导航单元,用于采用卫星导航模块控制所述自移动设备沿预设的工作方向S移动;
第二导航单元,用于采用惯性导航模块控制所述自移动设备从当前位置沿预设的工作方向S移动预设的时间段T;
记录单元,用于记录所述自移动设备对应移动后的位置坐标及所述自移
动设备的姿态。
在其中一个实施例中,所述第二控制模块包括:
第一控制单元,用于采用卫星导航模块控制所述自移动设备沿预设的工作方向S移动;
第二控制单元,用于采用惯性导航模块控制所述自移动设备沿预设方向S1移动预设的时间段T1。
本发明还提供一种自移动设备行走控制方法,自移动设备的行走区域包括无线信号盲区以及无线信号覆盖区,所述方法包括:
在所述自移动设备行走时检测其所处的行走区域;
当所述自移动设备处于所述无线信号盲区时,开始计时;
当所述自移动设备在所述无线信号盲区行走的时间超过第一时间阈值时,控制所述自移动设备后退或转向后继续行走第一时间阈值的时间;
当所述自移动设备后退或转向后继续行走第一时间阈值的时间后还在所述无线信号盲区时,控制所述自移动设备停机报警。
在其中一个实施例中,所述转向后继续行走第一时间阈值的时间的步骤为:控制所述自移动设备的行走方向旋转一角度后继续行走第一时间阈值的时间,所述角度介于0至180度之间。
在其中一个实施例中,所述无线信号覆盖区包括第一无线信号覆盖区和第二无线信号覆盖区,所述第一无线信号覆盖区的无线信号的强度高于所述第二无线信号覆盖区的无线信号的强度;所述方法还包括:
当所述自移动设备处于所述第二无线信号覆盖区时,开始计时;
当所述自移动设备在所述第二无线信号覆盖区行走的时间超过第二时间阈值时,控制所述自移动设备向所述第一无线信号覆盖区行走。
在其中一个实施例中,所述控制所述自移动设备向所述第一无线信号覆盖区行走的步骤包括:
获取所述自移动设备的当前位置与第一无线信号覆盖区的相对方向;
根据所述相对方向,控制所述自移动设备向所述第一无线信号覆盖区行走。
在其中一个实施例中,所述方法还包括:
当所述自移动设备从所述第二无线信号覆盖区行走至所述无线信号盲区时,计算所述自移动设备上一次处于所述第二无线信号覆盖区的时间;
当所计算的所述自移动设备上一次处于所述第二无线信号覆盖区的时间不超过第三时间阈值时,开始计时;
当所述自移动设备在所述无线信号盲区行走的时间超过第四时间阈值时,控制所述自移动设备后退或转向后继续行走第五时间阈值的时间;所述第四时间阈值小于所述第一时间阈值;
当所述自移动设备后退或转向后继续行走第五时间阈值的时间后还在所述无线信号盲区时,控制所述自移动设备停机报警。
在其中一个实施例中,当所计算的所述自移动设备上一次处于所述第二无线信号覆盖区的时间超过所述第三时间阈值且小于所述第二时间阈值时,控制所述自移动设备停机报警。
一种自移动设备行走控制系统,自移动设备的行走区域包括无线信号盲区以及无线信号覆盖区,所述系统包括:
控制器,用于在所述自移动设备行走时检测其所处的行走区域;
计时器,该计时器与所述控制器相连接,该计时器用于当所述自移动设备处于所述无线信号盲区时,开始计时;
转向器,该转向器与所述控制器相连接,该转向器用于当所述自移动设备在所述无线信号盲区行走的时间超过第一时间阈值时,控制所述自移动设备后退或转向;且在所述自移动设备后退或转向后,所述控制器还用于控制所述自移动设备继续行走第一时间阈值的时间;
报警器,该报警器与所述控制器相连接,该报警器用于当所述自移动设备后退或转向后继续行走第一时间阈值的时间后还在所述无线信号盲区时,控制所述自移动设备停机报警。
在其中一个实施例中,所述转向器包括:
角度设置模块,用于设置所述自移动设备的旋转角度,且所述角度介于0至180度之间;
转向模块,该转向模块分别与所述控制器以及所述角度设置模块相连接,该转向模块用于当所述自移动设备在所述无线信号盲区行走的时间超过第一时间阈值时,控制所述自移动设备后退或转向所述角度。
在其中一个实施例中,所述无线信号覆盖区包括第一无线信号覆盖区和第二无线信号覆盖区,所述第一无线信号覆盖区的无线信号的强度高于所述第二无线信号覆盖区的无线信号的强度;
所处所述计时器还用于当所述自移动设备所处所述第二无线信号覆盖区时,开始计时;
所述转向器还用于当所述自移动设备在所述第二无线信号覆盖区行走的时间超过第二时间阈值时,控制所述自移动设备向所述第一无线信号覆盖区行走。
在其中一个实施例中,所述控制器还用于当所述自移动设备从所述第二无线信号覆盖区行走至所述无线信号盲区时,计算所述自移动设备处于所述第二无线信号覆盖区的时间;
所述计时器还用于当所计算的所述自移动设备处于所述第二无线信号覆盖区的时间不超过第三时间阈值时,开始计时;
所述转向器还用于当所述自移动设备在所述无线信号盲区行走的时间超过第四时间阈值时,控制所述自移动设备后退或转向,所述第四时间阈值小于所述第一时间阈值;且在所述自移动设备后退或转向后,所述控制器还用于控制所述自移动设备继续行走第五时间阈值的时间;
所述报警器还用于当所述自移动设备后退或转向后继续行走第五时间阈值的时间后还在所述无线信号盲区时,控制所述自移动设备停机报警。
在其中一个实施例中,所述报警器还用于当所计算的所述自移动设备上一次处于所述第二无线信号覆盖区的时间超过所述第三时间阈值且小于所述第二时间阈值时,控制所述自移动设备停机报警。
上述的自移动设备行走控制方法和系统,通过判断自移动设备是否处于所述无线信号盲区来控制该自移动设备的运行,使得自移动设备在无线信号盲区等定位精度差的区域时,可以防止自移动设备走入危险区域,从而防止该自移动设备损坏。
以上所述的本发明的目的、技术方案以及有益效果可以通过下面附图实现:
图1为本发明的一实施例的自动工作系统示意图;
图2为本发明的一实施例的自动割草机的结构示意图;
图3是本发明的一实施例的自动割草机的移动方式示意图;
图4为本发明另一实施例的自动割草机的工作场景示意图;
图5为本发明另一实施例的自动割草机的导航方法流程图;
图6为本发明另一实施例的自动割草机行走控制方法的流程图;
图7为本发明另一实施例的自动割草机的行走区域的示意图;
图8为本发明另一实施例的自动割草机处于第二无线信号覆盖区时的行走控制方法的流程图;
图9为本发明再一实施例的自动割草机处于第二无线信号覆盖区时的行走控制方法的流程图;
图10为本发明另一实施例的自动割草机行走控制方法的流程图;
图11为本发明另一实施例的自动割草机行走控制系统的结构示意图。
图1为本发明的一实施例的自动工作系统100示意图。自动工作系统包括自移动设备。本实施例中,自移动设备为自动割草机1,在其他实施例中,自移动设备也可以为自动清洁设备、自动浇灌设备、自动扫雪机等适合无人值守的设备。自动工作系统100还包括充电站2,用于供自动割草机1停靠并补给电能。本实施例中,自动工作系统100包括导航模块,用于输出自动割草机的当前位置。具体的,导航模块包括基站17和移动站15。基站17和移动站15均接收卫星信号,基站17向移动站15发送定位修正信号,实现差分卫星定位。本实施例中,基站17和移动站15接收GPS定位信号,实现DGPS定位。当然,在其他实施例中,基站17和移动站15也可以接收伽利略卫星导航系统、或北斗卫星导航系统、或GLONASS等定位信号。
如图1所示,自动工作系统用于在预定的工作区域内工作,本实施例中,工作区域包括至少两个相互分离的子工作区域,子工作区域由通道400连通。工作区域与非工作区域之间形成边界200,工作区域内包括障碍9、11,障碍包括树木、凹坑等。
本实施例中的自动割草机1的结构如图2所示。自动割草机1包括壳体3,移动模块,任务执行模块,能源模块,控制模块等。其中,移动模块包括履带5,由驱动马达驱动以带动自动割草机1移动。任务执行模块包括切割组件7,执行割草工作。能源模块包括电池包(图未示),为自动割草机1的移动和工作提供电能。控制模块与移动模块、任务执行模块和能源模块电连接,控制移动模块带动自动割草机1移动,并控制任务执行模块执行工作任务。本实施例中,自动割草机包括卫星导航装置,与控制模块电连接,接收
卫星信号,输出自动割草机1的当前位置信息。卫星导航装置包括上述移动站15。
卫星导航装置输出的位置信息的质量随工作环境的变化而不同。当自动割草机位于开阔的工作区域时,移动站15能够接收到多颗卫星的导航信号,且移动站15与基站17之间的通讯没有遮挡时,卫星导航装置输出的位置信息的质量高。当自动割草机位于阴影区域,阴影区域可能是建筑物附近、或被树木、房檐等遮挡的区域,移动站15只能接收到少数几颗卫星的导航信号,或者接收不到卫星的导航信号,则卫星导航装置输出的位置信息的质量降低。另一种情况为,移动站15和基站17之间的通讯被遮挡,卫星导航装置输出的位置信息的质量也会降低。卫星导航装置输出位置信息的同时,可以输出定位信号的精度等级。自动割草机也可以根据卫星导航装置输出的位置信息来判断当前定位状态,输出定位状态指示。判断卫星导航装置输出的位置信息的质量的依据,可以是卫星导航装置能够接收到信号的卫星个数,或者定位状态指示,或者精度因子,或者多种因素综合,设置重要度权重,来获得位置信息质量。卫星导航装置输出的位置信息的质量可以由卫星导航装置本身进行评估,控制模块获取评估结果,也可以由控制模块利用卫星导航装置的输出进行评估,得到评估结果。
本实施例中,自动割草机还包括至少一个位置传感器,与控制模块电连接,检测与自动割草机的位置相关的特征。位置传感器可以包括摄像头、雷达、电容传感器、惯性导航传感器等。本实施例中,位置传感器为惯性导航传感器,惯性导航传感器可以包括加速度计、里程计、罗盘、陀螺仪、姿态检测传感器等,检测自移动设备的速度、加速度、行驶方向等。本实施例中,当卫星导航装置输出的位置信息的质量不满足预设条件时,控制模块至少部分的基于位置传感器的输出判断自动割草机的当前位置。具体的,可以将卫星导航装置输出的位置信息与位置传感器的输出进行融合处理,来得到自动割草机的当前位置。以惯性导航传感器为例,若持续利用惯性导航传感器进行导航,惯性导航传感器的输出的误差将随时间累积,导致输出的位置信息的精度降低。因此,当卫星导航装置输出的位置信息的质量满足预设条件时,利用卫星导航装置的输出来校正位置传感器的输出,以使得位置传感器能够
保持高精度的输出。
本实施例中,控制模块判断当前位置卫星导航装置输出的位置信息的质量是否满足预设条件,若不满足预设条件,则控制移动模块带动自动割草机改变移动方式,以使得在移动后的位置卫星导航装置输出的位置信息的质量满足预设条件。具体的,本实施例中,自动割草机包括存储单元,与控制模块及卫星导航装置电连接。存储单元可以是集成在导航模块中的存储单元,也可以是集成在自动割草机的控制电路中的存储单元。将卫星导航装置输出的位置信息的质量满足预设条件的位置称为期望位置,存储单元存储期望位置信息。控制模块控制移动模块带动自动割草机改变移动方式包括,控制移动模块带动自动割草机向期望位置移动。也就是说,自动割草机移动过程中,卫星导航装置或控制模块会对自动割草机移动经过的位置的卫星导航装置输出的位置信息的质量进行评估,记录卫星导航装置输出的位置信息质量满足预设条件的位置,通常为移动站能够接收到良好的卫星信号或基站信号的位置。当自动割草机进入阴影区域时,由于自动割草机不能在阴影区域中长时间的精确导航,因此,需要回到卫星导航信号良好的区域,利用卫星导航信号来修正位置传感器的输出,以使得自动割草机能够保持高精度导航,避免因为低精度导航导致的自动割草机离开工作区域的安全问题,以及自动割草机的工作效率降低的问题等。
本实施例中,控制模块判断存储单元存储的若干期望位置与自动割草机的当前位置的距离,根据期望位置与自动割草机的当前位置的距离选择若干期望位置的其中之一,控制移动模块带动自动割草机向被选择的期望位置移动。具体的,本实施例中,控制模块控制移动模块带动自动割草机向距离自动割草机的当前位置最近的期望位置移动。在其他实施例中,也可以设定期望位置与自动割草机的当前位置的距离范围,控制自动割草机向符合距离范围的期望位置移动。控制自动割草机向距离最近的期望位置、或距离符合预设范围的期望位置移动,能够提高自动割草机的工作效率,减少能量的消耗。
本实施例中,将自动割草机改变移动方式之前,所在的卫星导航装置输出的位置信息的质量不满足预设条件的位置称为原始位置,存储单元存储原始位置的信息。自动割草机移动至期望位置后,控制模块控制移动模块带动
自动割草机返回原始位置。在自动割草机移动至期望位置后,卫星导航装置输出的位置信息的质量提高,自动割草机重新获得高精度的位置信息,位置传感器的输出也得到校正。因此,自动割草机返回原始位置时,能够保持高精度的导航,使得自动割草机能够完成在阴影区域内的切割工作,解决自动割草机无法在阴影区域内完成切割的问题。可以理解的是,自动割草机向原始位置移动,也可以不回到改变移动方式之前的特定的某一点,而只是向该方向移动,回到未完成切割的区域。
本实施例中,控制模块控制移动模块带动自动割草机沿预设路径移动。预设路径可以是平行往复路径、螺旋路径等。当控制模块判断卫星导航装置输出的位置信息不满足预设条件时,则改变自动割草机的移动方式。具体的,自动割草机的移动方式可参考图3。本实施例中,控制模块控制移动模块带动自动割草机改变移动方式之前,控制模块控制移动模块带动自动割草机沿平行直线移动。当控制模块判断卫星导航装置输出的位置信息的质量不满足预设条件后,控制移动模块带动自动割草机沿平行直线继续移动预设时间或预设距离,在该预设时间或预设距离内,惯性导航传感器的输出误差小,自动割草机能够维持较高精度的导航。自动割草机移动预设时间或预设距离后,控制模块控制移动模块带动自动割草机向第一期望位置移动,第一期望位置为存储单元所记录的期望位置中,距离自动割草机的当前位置最近的期望位置。自动割草机移动至第一期望位置后,自动割草机的卫星导航信号良好,利用卫星导航信号校正惯性导航传感器的输出的误差,使惯性导航传感器的输出恢复高精度。自动割草机再返回原始位置,沿预设的平行直线路径继续移动,即继续在阴影区域内执行割草工作。自动割草机移动过程中,若卫星导航装置输出的位置信息的质量仍然是不满足预设条件的,则自动割草机移动预设时间或预设距离后将再次改变移动方式,重复上述步骤,直至自动割草机离开阴影区域。
本实施例中,当自动割草机移动至卫星导航信号差的区域时,通过改变移动方式使自动割草机仍然能够保持高精度的导航,且能够完成对卫星导航信号差的区域的切割,使得自动割草机能够高效率的完成对整个工作区域的切割。
本实施例中,卫星导航装置输出的位置信息的质量需满足的预设条件,如上所述,可以依据卫星导航装置能够接收到信号的卫星个数、或者定位状态指示,或者精度因子,或者多种因素的组合来确定,例如,预设条件可以是卫星导航装置接收到信号的卫星个数大于等于4颗等。
可以理解的是,图3仅为本实施例的自动割草机的移动方式的示意图,自动割草机改变移动方式的具体路径可以灵活的选择。自动割草机向期望位置移动后,也可以不立即返回原始位置,而是在完成整个工作区域或部分工作区域的切割后再返回未切割的阴影区域。自动割草机行走至期望位置后,可以沿未覆盖的预设路径继续移动,或者重新规划路径。
本发明的另一实施例中,如图4中所示,当自动割草机1沿着栅栏/树木/花丛等障碍物旁行走时(图4中虚线部分为栅栏/树木/花丛等障碍物形成的阴影),由于遮挡会造成GPS信号较差,此时如果继续使用GPS导航,基本上属于“盲导”,会造成较大的误差,如果让自动割草机停止工作,等待GPS信号变强后再进行割草任务,则明显降低效率。在这种情况下,自动割草机也可以采用自身携带的惯性导航系统进行导航工作,但根据惯性导航系统的工作原理(惯性导航的工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,且把它变换到导航坐标系中,就能够得到在导航坐标系中的速度、偏航角和位置等信息。)可知,惯性导航系统属于推算导航方式,随着时间的延长,精度必然降低,并不利于自动割草机长时间的工作。
为此,如图5所示,一实施例的自移动设备的导航方法包括步骤S110至S160。
步骤S110,检测自移动设备是否可以接收到稳定的卫星导航信号,若自移动设备可以接收到稳定的卫星导航信号,则进入步骤S160;
步骤S120,若自移动设备不能接收到稳定的卫星导航信号,自移动设备采用惯性导航方式从当前位置沿预设的工作方向S移动预设的时间段T,并记录自移动设备对应移动后的位置坐标;
步骤S130,检测自移动设备是否可以接收到稳定的卫星导航信号,若自移动设备可以接收到稳定的卫星导航信号,则进入步骤S160;
步骤S140,若自移动设备不能接收到稳定的卫星导航信号,自移动设备采用惯性导航方式从自移动设备沿工作方向S移动预设的时间段T后的位置坐标处沿预设方向S1移动预设的时间段T1,其中,自移动设备沿预设方向S1移动预设的时间段T1后能够接收到稳定的卫星导航信号;
步骤S150,采用卫星导航方式控制自移动设备沿预设方向S1的反方向返回至自移动设备沿预设的工作方向S移动预设的时间段T后的位置坐标,且所述自移动设备移动前后姿态相同,并进入步骤S120;
步骤S160,自移动设备采用卫星导航方式控制自移动设备沿预设的工作方向S移动,直至自移动设备完成工作任务。
以上自移动设备的导航方法,在无法接收到卫星导航信号时,可以采用惯性导航与卫星导航交替的方式,保证自移动设备工作时的路线正确,提高导航精度,减小导航误差。
其中,自移动设备采用惯性导航方式时,如果自移动设备沿预设的工作方向S移动的时间段T时间过长,会导致自移动设备的路径误差偏大,因此,时间段T应该限制在一定的范围内。当自移动设备沿预设方向S1移动的时间段T1时间过长时,由于预设方向S1非工作方向,其只是为了纠正路径误差,因此,时间段T1也应该限制在一定的范围内,在最大可能的纠正导航误差的同时尽可能减少自移动设备的能源消耗。自移动设备沿S和S1移动时,其对应的移动时间T和T1之和,应当小于所述自移动设备可保持惯性导航高精度定位的时间,以充分保证自移动设备采用惯性导航沿S和S1移动的准确性。
当自移动设备沿预设方向S1移动时,应当保证自移动设备可以最快的接收到稳定的卫星导航信号,因此,预设方向S1与工作方向S之间的夹角包括但不限于90度,以尽量缩小自移动设备沿预设方向S1移动时可以接收到卫星导航信号的时间,而对应的,可以将时间段T1预设为最小的时间,提高自移动设备的工作效率。
当自移动设备沿预设方向S1移动时,自移动设备所处的区域不同,不同的区域可接收到卫星信号的情况也不同,因此,自移动设备在不同的区域沿方向S1移动时可以接收到稳定的卫星导航信号的时间也不同,即自移动
设备沿方向S1移动的时间段T1在不同的区域可能不同,如可以是5秒、6秒、10秒等,但时间段T1应当是自移动设备沿预设方向S1移动时可以接收到卫星导航信号的最小时间。
自移动设备可以是各种设备,尤其是自动割草机。自动割草机按照以上导航方法工作的示意图如图3所示,当自动割草机R接收不到卫星导航信号时,采用惯性导航方式沿工作方向S移动时间段T到A,如在A无法接收到卫星导航信号,则沿预设方向S1移动时间段T1到B(其中,自动割草机在B点能够接收到稳定的卫星导航信号),自动割草机从B点返回到A点;之后,自动割草机从A点沿工作方向S移动时间段T到C,如在C点无法接收到卫星导航信号,则沿预设方向S1移动时间段T1到D(其中,自动割草机在D点能够接收到稳定的卫星导航信号),自动割草机从D点返回到C点;之后,自动割草机从C点沿工作方向S移动时间段T到E点,如在E点无法接收到卫星导航信号,则沿预设方向S1移动时间段T1到F点(其中,自动割草机在F点能够接收到稳定的卫星导航信号),自动割草机从F点返回到E点。如此循环,直到自动割草机可以接收到稳定的卫星导航信号时以卫星导航方式移动,直到工作任务完成。
本实施例还提供了采用以上导航方法进行导航的自移动设备,包括卫星导航模块和惯性导航模块,还包括:
检测模块,用于检测卫星导航模块是否可以接收到稳定的卫星导航信号;
第一控制模块,用于在检测模块检测到卫星导航模块可以接收到稳定的卫星导航信号时,采用卫星导航模块控制自移动设备沿预设的工作方向S移动,或者在检测模块检测到卫星导航模块不能接收到稳定的卫星导航信号时,采用惯性导航模块控制自移动设备从当前位置沿预设的工作方向S移动预设的时间段T,并记录自移动设备对应移动后的位置坐标;
第二控制模块,用于在检测模块检测到卫星导航模块可以接收到稳定的卫星导航信号时,采用卫星导航模块控制自移动设备沿预设的工作方向S移动,或者在检测模块检测到卫星导航模块不能接收到稳定的卫星导航信号时,采用惯性导航模块控制自移动设备沿预设方向S1移动预设的时间段T1,其中,自移动设备沿预设方向S1移动预设的时间段T1后能够接收到稳定的卫
星导航信号;
第三控制模块,用于采用卫星导航模块控制自移动设备沿预设方向S1的反方向返回至自移动设备沿预设的工作方向S移动预设的时间段T后的位置坐标;
总控模块,用于控制检测模块、第一控制模块、第二控制模块及第三控制模块工作。
以上自移动设备的导航方法,在无法接收到卫星导航信号时,可以采用惯性导航与卫星导航交替的方式,保证自移动设备工作时的路线正确,提高导航精度,减小导航误差。
其中,自移动设备采用惯性导航方式时,如果自移动设备沿预设的工作方向S移动的时间段T时间过长,会导致自移动设备的路径误差偏大,因此,时间段T的应该限制在一定的范围内。当自移动设备沿预设方向S1移动的时间段T1时间过长时,由于预设方向S1非工作方向,其只是为了纠正路径误差,因此,时间段T1也应该限制在一定的范围内,在最大可能的纠正导航误差的同时尽可能减少自移动设备的能源消耗。为此,预设的时间段T与T1之和小于所述自移动设备可保持惯性导航高精度定位的时间。
当自移动设备沿预设方向S1移动时,应当保证自移动设备可以最快的接收到稳定的卫星导航信号,因此,预设方向S1与工作方向S之间的夹角包括但不限于90度,以尽量缩小自移动设备沿预设方向S1移动时可以接收到卫星导航信号的时间,而对应的,可以将时间段T1预设为最小的时间,提高自移动设备的工作效率。
其中,第一控制模块包括:
第一导航单元,用于采用卫星导航模块控制自移动设备沿预设的工作方向S移动;
第二导航单元,用于采用惯性导航模块控制自移动设备从当前位置沿预设的工作方向S移动预设的时间段T;
记录单元,用于记录自移动设备对应移动后的位置坐标及所述自移动设备的姿态。
其中,第二控制模块包括:
第一控制单元,用于采用卫星导航模块控制自移动设备沿预设的工作方向S移动;
第二控制单元,用于采用惯性导航模块控制自移动设备沿预设方向S1移动预设的时间段T1。
本发明的另一实施例中,请参阅图6所示,图6为自移动设备行走控制方法的流程图,在该实施例中,自移动设备的行走区域包括无线信号盲区以及无线信号覆盖区,该方法包括:
S102:在自移动设备行走时检测其所处的行走区域。
由于移动站的DGPS的定位精度的提高是通过与基站的通信进行的,即移动站需要实时接收基站发送的伪距离修正值,但是在实际应用中,由于存在房屋等障碍物的遮挡,基站与移动站的通信会出现盲区或者信号较差的区域,因此会影响移动站的精确定位。因此在该实施例中,首先判断出该自移动设备所处的行走区域,如果是处于无线信号盲区,则通过相应的控制策略来保证自移动设备不会进入危险区域,从而防止自移动设备的损坏。
S104:当自移动设备处于无线信号盲区时,开始计时。
在该实施例中,控制自移动设备继续行走,通常可以是控制自移动设备按照预先规划的路径继续行走,或者也可以通过一定的控制策略,控制自移动设备的行走。
S106:判断自移动设备在无线信号盲区行走的时间是否超过第一时间阈值。
在该实施例中,通常当自移动设备进入无线信号盲区时,会控制自移动设备按照预先规划的路径继续行走,如果在第一时间阈值内,该自移动设备行走出该无线信号盲区,即该自移动设备行走到无线信号覆盖区时,则自移动设备继续按照预先规划的路径行走,如果自移动设备在第一时间阈值内还在该无线信号盲区时,则如果按照预先规划的路径继续行走,该自移动设备可能会行走到危险的区域,因此需要控制该自移动设备的行走,具体可以参见下文。另外,该第一时间阈值可以预先根据无线信号盲区的宽度和长度来设置,例如,可以为5秒、10秒、15秒、18秒、20秒等,但是一般情况下,该第一时间阈值小于等于10秒。
S108:当自移动设备在无线信号盲区行走的时间超过第一时间阈值时,控制自移动设备后退或转向后继续行走第一时间阈值的时间,否则,返回步骤S106,判断自移动设备在无线信号盲区行走的时间是否超过第一时间阈值。
在该实施例中,由于自移动设备在该无线信号盲区停留的时间已经超过第一时间阈值,因此为了避免该自移动设备的走入危险区域,最安全的做法是让该自移动设备按原路线返回,即后退,继续行走第一时间阈值的时间,或者在其他的实施例中,还可以控制该自移动设备转向,例如,控制自移动设备的行走方向旋转一角度后继续行走第一时间阈值的时间,角度介于0至180度之间。
S111:判断自移动设备后退或转向后继续行走第一时间阈值的时间后是否还在无线信号盲区。
S112:当自移动设备后退或转向后继续行走第一时间阈值的时间后还在无线信号盲区时,控制自移动设备停机报警,否则,返回步骤S102,判断自移动设备是否处于无线信号盲区。
在该实施例中,控制该自移动设备停机报警,可以通过蜂鸣器等设备进行,也可以将该自移动设备处于无线信号盲区的信息发送回后台。
上述的自移动设备行走控制方法,通过判断自移动设备是否处于无线信号盲区来控制该自移动设备的运行,使得自移动设备可以在无线信号盲区等定位精度差的区域时,可以防止自移动设备走入危险区域,从而防止该自移动设备的损坏。
在其中一个实施例中,请参阅图7所示,图7为一实施例中的自移动设备的行走区域的示意图。在该实施例中,无线信号覆盖区包括第一无线信号覆盖区和第二无线信号覆盖区,第一无线信号覆盖区的无线信号的强度高于第二无线信号覆盖区的无线信号的强度;一般情况下,第一无线信号覆盖区指的是无线信号好的区域,第二无线信号覆盖区指的是无线信号较差的区域,在第二无线信号区内,该自移动设备可以获取基站发来的PRC信号,但该PRC信号的信号强度较差,干扰较多。请参阅图8所示,图8为一实施例中的自移动设备处于第二无线信号覆盖区时的行走控制方法的流程图。在该实
施例中,该方法包括:
S302:在所述自移动设备行走时检测其所处的行走区域。
在该实施例中,将无线信号覆盖区划分为第一无线信号覆盖区和第二无线信号覆盖区,在第一无线信号覆盖区可以实现自移动设备的精确定位,自移动设备按照预先的规划路径继续行走即可,但是如果自移动设备处于第二无线信号覆盖区,此时由于自移动设备上的移动站接收的基站的信号干扰较多,导致自移动设备的定位不再精确,从而如果自移动设备继续行走可能导致其进入危险的区域,因此需要控制自移动设备的行走,具体可参见下文。
S304:当自移动设备处于第二无线信号覆盖区时,开始计时。
在该实施例中,第二时间阈值的大小可以根据第二无线信号覆盖区的长度和宽度进行设置,可以为10秒、15秒、22秒、25秒、28秒、30秒、35秒等但是一般情况下,第二时间阈值小于等于30秒,且第二时间阈值一般大于第一时间阈值。
S306:判断自移动设备在第二无线信号覆盖区行走的时间是否超过第二时间阈值。
S308:当自移动设备在第二无线信号覆盖区行走的时间超过第二时间阈值时,控制自移动设备向第一无线信号覆盖区行走,否则,返回步骤S306,判断自移动设备在第二无线信号覆盖区行走的时间是否超过第二时间阈值。
在该实施例中,由于自移动设备并非完全无法接收到基站的信号,只是接收到的基站的信号较差,因此该自移动设备可以大致获取自移动设备的当前位置与第一无线信号覆盖区的相对方向,从而该自移动设备可以根据该相对方向向第一无线信号覆盖区行走,因此控制自移动设备向第一无线信号覆盖区行走的步骤可以包括:获取自移动设备的当前位置与第一无线信号覆盖区的相对方向;根据相对方向,控制自移动设备向第一无线信号覆盖区行走。
在其中一个实施例中,当自移动设备在第二时间阈值时间内从第二无线信号覆盖区行走至第一无线信号覆盖区时,则该自移动设备而按照预先规划的路径继续行走即可,但是如果当自移动设备在第二时间阈值时间内从第二无线信号覆盖区行走到无线信号盲区时,则该自移动设备无法获取自己的精确的定位,因此请参阅图9所示,图9为再一实施例中的自移动设备处于第
二无线信号覆盖区时的行走控制方法的流程图。在该实施例中,该方法还包括:
S402:判断自移动设备是否从第二无线信号覆盖区行走至无线信号盲区。
S404:当自移动设备从第二无线信号覆盖区行走至无线信号盲区时,计算自移动设备上一次处于第二无线信号覆盖区的时间,否则,进行步骤S420,判断自移动设备是否从第二无线信号覆盖区行走至第一无线信号覆盖区。
由于自移动设备是从第二无线信号覆盖区行走至无线信号盲区的,由于在第二无线信号覆盖区中,该自移动设备已经无法精确地进行定位,如果再行走至无线信号盲区的时间较长的话,则该自移动设备无法精确定位的时间过长,极有可能导致该自移动设备行走到危险区域,因此需要计算该自移动设备在第二无线信号覆盖区行走的时间,根据该时间来确定该自移动设备在无线信号盲区的行走时间的阈值。
S406:判断所计算的自移动设备上一次处于第二无线信号覆盖区的时间是否不超过第三时间阈值。在该实施例中,第三时间阈值可以为5秒、6秒、8秒、10秒、12秒、15秒、18秒等,通常第三时间阈值一般小于等于10秒,且第三时间阈值小于第二时间阈值。
S408:当所计算的自移动设备上一次处于第二无线信号覆盖区的时间不超过第三时间阈值时,开始计时,否则,进行步骤S418:控制自移动设备停机报警。
S410:判断自移动设备在无线信号盲区行走的时间是否超过第四时间阈值。
在该实施例中,第四时间阈值根据自移动设备上一次处于第二无线信号覆盖区的时间来确定,第四时间阈值可以为5秒、7秒、9秒、12秒、15秒、18秒等,且一般第四时间阈值小于10秒,且第四时间阈值小于第一时间阈值。
S412:当自移动设备在无线信号盲区行走的时间超过第四时间阈值时,控制自移动设备后退或转向后继续行走第五时间阈值的时间。在该实施例中,第五时间阈值可以为5秒、7秒、9秒、12秒、15秒、18秒等,且一般第五
时间阈值一般为10秒,第五时间阈值等于或大于第四时间阈值。
S414:判断自移动设备后退或转向后继续行走第五时间阈值的时间后是否还在无线信号盲区。
S416:当自移动设备后退或转向后继续行走第五时间阈值的时间后还在无线信号盲区时,控制自移动设备停机报警。
S418:控制自移动设备停机报警。
S420:判断自移动设备是否从第二无线信号覆盖区行走至第一无线信号覆盖区。
S422:当自移动设备从第二无线信号覆盖区行走至第一无线信号覆盖区时,则控制自移动设备按照预先规划的路径行走,否则返回步骤S306,继续判断自移动设备在第二无线信号覆盖区行走的时间是否超过第二时间阈值。
在该实施例中,控制该自移动设备停机报警,可以通过蜂鸣器等设备进行,也可以将该自移动设备处于无线信号盲区的信息发送回后台。
在其中一个实施例中,当所计算的自移动设备上一次处于第二无线信号覆盖区的时间超过第三时间阈值且小于第二时间阈值时,控制自移动设备停机报警。
为了使得本领域技术人员充分理解本实施例中的方法,下面结合图10对本实施例中的自移动设备行走控制方法进行说明,图10为另一实施例中自移动设备行走控制方法的流程图。在该实施例中,首先控制自移动设备开始行走。
如果自移动设备位于第一无线信号覆盖区,则控制自移动设备按照预先规划的路径行走。
如果自移动设备位于无线信号盲区,则控制自移动设备按照预先规划的路径行走并开始计时,如果在该无线信号盲区内行走的时间超过第一阈值时间,则控制该自移动设备后退或转向后继续行走第一时间阈值的时间,如果行走完该第一时间阈值的时间后,该自移动设备还在该无线信号盲区,则停机报警。
如果自移动设备位于该第二无线信号覆盖区,则控制该自移动设备按照预先规划的路径行走并开始计时,如果在该第二无线信号覆盖区内行走的时
间超过第二时间阈值,则控制自移动设备向第一无线信号覆盖区行走。如果在该第二无线信号覆盖区内行走的时间未超过第二时间阈值,则控制自移动设备继续行走,并判断该自移动设备是否行走到无线信号盲区,如果行走到无线信号盲区,则计算上一次处于第二无线信号覆盖区的时间,并判断上一次处于第二无线信号覆盖区的时间是否超过第三时间阈值,如果未超过该第三时间阈值则控制自移动设备按照预先规划的路径继续行走,并判断该自移动设备在该无线信号盲区行走的时间是否超过第四时间阈值,如果超过该第四时间阈值,则控制该自移动设备后退或转向后继续行走第五时间阈值的时间,如果行走完第五时间阈值的时间后,该自移动设备还在该无线信号盲区,则停机报警。
请参阅图11所示,图11为一实施例中自移动设备行走控制系统的结构示意图,在该实施例中,自移动设备的行走区域包括无线信号盲区以及无线信号覆盖区,所述系统可以包括控制器、计时器、转向器以及报警器。该计时器与控制器相连接,该转向器与控制器相连接,该报警器与控制器相连接。控制器用于在自移动设备行走时检测其是否所处无线信号盲区;计时器用于当自移动设备处于无线信号盲区时,开始计时;转向器用于当自移动设备在无线信号盲区行走的时间超过第一时间阈值时,控制自移动设备后退或转向;且在自移动设备后退或转向后,控制器还用于控制自移动设备继续行走第一时间阈值的时间;报警器用于当自移动设备后退或转向后继续行走第一时间阈值的时间后还在无线信号盲区时,控制自移动设备停机报警。
在其中一个实施例中,转向器可以包括:角度设置模块,用于设置自移动设备的旋转角度,且角度介于0至180度之间;转向模块,该转向模块分别与控制器以及角度设置模块相连接,该转向模块用于当自移动设备在无线信号盲区行走的时间超过第一时间阈值时,控制自移动设备后退或转向角度。
在其中一个实施例中,无线信号覆盖区包括第一无线信号覆盖区和第二无线信号覆盖区,第一无线信号覆盖区的无线信号的强度高于第二无线信号覆盖区的无线信号的强度;控制器还用于在自移动设备行走时检测其所处第二无线信号覆盖区;计时器还用于当自移动设备处于第二无线信号覆盖区时,开始计时;转向器还用于当自移动设备在第二无线信号覆盖区行走的时间超
过第二时间阈值时,控制自移动设备向第一无线信号覆盖区行走。在其中一个实施例中,第一时间阈值和第二时间阈值的取值可以参见上文所述,一般第一时间阈值小于等于10秒,第二时间阈值小于等于30秒。
在其中一个实施例中,控制器还用于当自移动设备从第二无线信号覆盖区行走至无线信号盲区时,计算自移动设备处于第二无线信号覆盖区的时间;计时器还用于当所计算的自移动设备处于第二无线信号覆盖区的时间不超过第三时间阈值时,开始计时;转向器还用于当自移动设备在无线信号盲区行走的时间超过第四时间阈值时,控制自移动设备后退或转向,第四时间阈值小于第一时间阈值;且在自移动设备后退或转向后,控制器还用于控制计时器驱动自移动设备继续行走第五时间阈值的时间;报警器还用于当自移动设备后退或转向后继续行走第五时间阈值的时间后还在无线信号盲区时,控制自移动设备停机报警。
在其中一个实施例中,报警器还用于当所计算的自移动设备上一次处于第二无线信号覆盖区的时间超过第三时间阈值且小于第二时间阈值时,控制自移动设备停机报警。
在其中一个实施例中,第三时间阈值、第四时间阈值以及第五时间阈值的范围可以参见上文所述,一般第三时间阈值小于等于10秒,第四时间阈值小于10秒,第五时间阈值等于10秒。
本发明不局限于所举的具体实施例,基于本发明构思的结构和方法均属于本发明保护范围。
Claims (23)
- 一种自移动设备,包括:移动模块、任务执行模块和控制模块;所述控制模块与移动模块、任务执行模块电连接,控制移动模块带动自移动设备移动,并控制任务执行模块执行工作任务;所述自移动设备还包括卫星导航装置,与控制模块电连接,接收卫星信号,输出自移动设备的当前位置信息;其特征在于,所述控制模块判断当前位置所述卫星导航装置输出的位置信息的质量是否满足预设条件,若不满足预设条件,则控制所述移动模块带动自移动设备改变移动方式,以使得在移动后的位置所述卫星导航装置输出的位置信息的质量满足预设条件。
- 根据权利要求1所述的自移动设备,其特征在于,所述自移动设备包括存储单元,与控制模块及卫星导航装置电连接;将卫星导航装置输出的位置信息的质量满足预设条件的位置称为期望位置;所述存储单元存储期望位置信息;所述控制模块控制移动模块带动自移动设备改变移动方式包括,控制所述移动模块带动自移动设备向所述期望位置移动。
- 根据权利要求2所述的自移动设备,其特征在于,所述控制模块判断所述存储单元存储的若干期望位置与自移动设备的当前位置的距离,根据期望位置与自移动设备的当前位置的距离选择若干期望位置的其中之一,控制移动模块带动自移动设备向被选择的期望位置移动。
- 根据权利要求3所述的自移动设备,其特征在于,所述控制模块控制移动模块带动自移动设备向距离自移动设备的当前位置最近的期望位置移动。
- 根据权利要求2所述的自移动设备,其特征在于,将自移动设备改变移动方式之前,所在的所述卫星导航装置输出的位置信息的质量不满足预设条件的位置称为原始位置,所述存储单元存储所述原始位置的信息;所述自移动设备移动至期望位置后,所述控制模块控制所述移动模块带动自移动设备返回所述原始位置。
- 根据权利要求5所述的自移动设备,其特征在于,所述控制模块控制所述移动模块带动自移动设备改变移动方式之前,所述控制模块控制所述移动模块带动自移动设备沿预设路径移动;所述控制模块控制所述移动模块带动自移动设备返回所述原始位置后,控制所述移动模块带动自移动设备继续沿预 设路径移动。
- 根据权利要求1所述的自移动设备,其特征在于,所述控制模块控制所述移动模块带动自移动设备改变移动方式之前,所述控制模块控制所述移动模块带动自移动设备沿预设路径移动;所述控制模块在判断当前位置所述卫星导航装置输出的位置信息的质量不满足预设条件后,控制移动模块带动自移动设备沿预设路径继续移动预设时间或预设距离,再改变移动方式。
- 根据权利要求1所述的自移动设备,其特征在于,所述自移动设备还包括至少一个位置传感器,与控制模块电连接,检测与自移动设备的位置相关的特征;当卫星导航装置输出的位置信息的质量不满足预设条件时,所述控制模块至少部分的基于所述位置传感器的输出判断所述自移动设备的当前位置。
- 根据权利要求8所述的自移动设备,其特征在于,所述位置传感器包括摄像头,雷达,电容传感器,惯性导航传感器的至少其中之一。
- 根据权利要求8所述的自移动设备,其特征在于,当所述卫星导航装置输出的位置信息的质量满足预设条件时,所述自移动设备利用所述卫星导航装置的输出来校正所述位置传感器的输出。
- 根据权利要求1所述的自移动设备,其特征在于,所述预设条件包括,卫星导航装置接收到信号的卫星个数大于等于预设值。
- 一种自动工作系统,包括前述任一项所述的自移动设备。
- 一种自移动设备的控制方法,所述自移动设备包括卫星导航装置,接收卫星信号,输出自移动设备的当前位置信息;其特征在于,所述自移动设备的控制方法包括步骤:判断当前位置所述卫星导航装置输出的位置信息的质量是否满足预设条件;若不满足预设条件,则控制自移动设备改变移动方式,以使得在移动后的位置所述卫星导航装置输出的位置信息的质量满足预设条件。
- 根据权利要求13所述的自移动设备的控制方法,其特征在于,将卫星导航装置输出的位置信息的质量满足预设条件的位置称为期望位置;存储期望位置信息;改变移动方式包括步骤,控制所述自移动设备向所述期望位置移动。
- 根据权利要求14所述的自移动设备的控制方法,其特征在于,判断存储的若干期望位置与自移动设备的当前位置的距离,根据期望位置与自移动设 备的当前位置的距离选择若干期望位置的其中之一,控制自移动设备向被选择的期望位置移动。
- 根据权利要求15所述的自移动设备的控制方法,其特征在于,控制自移动设备向距离自移动设备的当前位置最近的期望位置移动。
- 根据权利要求14所述的自移动设备的控制方法,其特征在于,将自移动设备改变移动方式之前,所在的所述卫星导航装置输出的位置信息的质量不满足预设条件的位置称为原始位置,存储所述原始位置;控制自移动设备移动至期望位置后,再控制自移动设备返回所述原始位置。
- 根据权利要求17所述的自移动设备的控制方法,其特征在于,自移动设备改变移动方式之前,控制自移动设备沿预设路径移动;自移动设备返回所述原始位置后,控制自移动设备继续沿预设路径移动。
- 根据权利要求13所述的自移动设备的控制方法,其特征在于,自移动设备改变移动方式之前,控制自移动设备沿预设路径移动;判断当前位置所述卫星导航装置输出的位置信息的质量不满足预设条件后,控制自移动设备沿预设路径继续移动预设时间或预设距离,再改变移动方式。
- 根据权利要求13所述的自移动设备的控制方法,其特征在于,所述自移动设备还包括至少一个位置传感器,检测与自移动设备的位置相关的特征;当卫星导航装置输出的位置信息的质量不满足预设条件时,至少部分的基于所述位置传感器的输出判断所述自移动设备的当前位置。
- 根据权利要求20所述的自移动设备的控制方法,其特征在于,所述位置传感器包括摄像头,雷达,电容传感器,惯性导航传感器的至少其中之一。
- 根据权利要求20所述的自移动设备的控制方法,其特征在于,当所述卫星导航装置输出的位置信息的质量满足预设条件时,利用所述卫星导航装置的输出来校正所述位置传感器的输出。
- 根据权利要求13所述的自移动设备的控制方法,其特征在于,所述预设条件包括,卫星导航装置接收到信号的卫星个数大于等于预设值。
Priority Applications (7)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP21215625.1A EP3998452B1 (en) | 2016-04-12 | 2017-04-12 | Automatic movement device for automatic working system, and control method therefor |
EP23219414.2A EP4339729A3 (en) | 2016-04-12 | 2017-04-12 | Automatic movement device for automatic working system, and control method therefor |
EP17781905.9A EP3444565B1 (en) | 2016-04-12 | 2017-04-12 | Automatic movement device for automatic working system, and control method therefor |
DE17781905.9T DE17781905T1 (de) | 2016-04-12 | 2017-04-12 | Vorrichtung mit automatischer bewegung für automatisches arbeitssystem und steuerungsverfahren dafür |
US16/157,906 US11442466B2 (en) | 2016-04-12 | 2018-10-11 | Automatic working system, self-moving device, and methods for controlling same |
US17/943,503 US11841710B2 (en) | 2016-04-12 | 2022-09-13 | Automatic working system, self-moving device, and methods for controlling same |
US18/388,704 US20240077885A1 (en) | 2016-04-12 | 2023-11-10 | Automatic working system, self-moving device, and methods for controlling same |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610224652 | 2016-04-12 | ||
CN201610224652.2 | 2016-04-12 | ||
CN201610805198.X | 2016-09-06 | ||
CN201610805198 | 2016-09-06 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US16/157,906 Continuation US11442466B2 (en) | 2016-04-12 | 2018-10-11 | Automatic working system, self-moving device, and methods for controlling same |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017177929A1 true WO2017177929A1 (zh) | 2017-10-19 |
Family
ID=60041415
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2017/080313 WO2017177929A1 (zh) | 2016-04-12 | 2017-04-12 | 自动工作系统自移动设备及其控制方法 |
Country Status (5)
Country | Link |
---|---|
US (3) | US11442466B2 (zh) |
EP (3) | EP3998452B1 (zh) |
CN (2) | CN112731945B (zh) |
DE (1) | DE17781905T1 (zh) |
WO (1) | WO2017177929A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020009414A (ja) * | 2018-06-28 | 2020-01-16 | パナソニックIpマネジメント株式会社 | 移動ロボット、及び、制御方法 |
JPWO2019180765A1 (ja) * | 2018-03-19 | 2020-12-10 | 本田技研工業株式会社 | 自律走行作業機 |
US20210116581A1 (en) * | 2019-10-22 | 2021-04-22 | Neutron Holdings, Inc. Dba Lime | Leveraging operations depots for antenna placement to gather phase and position data |
US11073828B2 (en) * | 2017-12-08 | 2021-07-27 | Samsung Electronics Co., Ltd. | Compression of semantic information for task and motion planning |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112731945B (zh) | 2016-04-12 | 2024-04-12 | 苏州宝时得电动工具有限公司 | 自动工作系统,自移动设备及其控制方法 |
WO2019096260A1 (zh) * | 2017-11-16 | 2019-05-23 | 苏州宝时得电动工具有限公司 | 自移动设备及其工作系统、识别方法、工作方法 |
CN108225362A (zh) * | 2017-12-29 | 2018-06-29 | 驭势科技(北京)有限公司 | 智能驾驶车辆定位方法和系统、计算机存储介质和定位设备 |
CN110347144B (zh) * | 2018-04-03 | 2023-06-09 | 苏州宝时得电动工具有限公司 | 自移动设备及其自学习方法、可读存储介质 |
CN110720176A (zh) * | 2018-04-24 | 2020-01-21 | 苏州宝时得电动工具有限公司 | 自移动设备 |
US20210294348A1 (en) * | 2018-08-08 | 2021-09-23 | Positec Power Tools (Suzhou) Co., Ltd. | Self-moving device, automatic working system, and control method therefor |
CN109101025A (zh) * | 2018-08-16 | 2018-12-28 | 江苏大学 | 一种用于遥控农业机器人穿过信号盲区的安全渡越方法 |
CN109588101B (zh) * | 2018-10-31 | 2022-04-05 | 浙江亚特电器有限公司 | 用于提高智能割草机作业覆盖率的控制方法 |
CN110132270B (zh) * | 2019-06-13 | 2021-08-31 | 深圳汉阳科技有限公司 | 自动扫雪装置定位方法 |
CN111123302A (zh) * | 2019-07-10 | 2020-05-08 | 广东星舆科技有限公司 | 定位参考信息的显示方法、移动终端及可读介质 |
CN112857368B (zh) * | 2019-11-12 | 2024-04-09 | 苏州宝时得电动工具有限公司 | 一种割草机导航方法、装置和割草机 |
EP3828658B1 (de) | 2019-11-27 | 2022-07-13 | Andreas Stihl AG & Co. KG | Verfahren zum bestimmen einer roboter-position eines autonomen mobilen grünflächenbearbeitungsroboters auf einer zu bearbeitenden fläche, verfahren zum betreiben eines autonomen mobilen grünflächenbearbeitungsroboters auf einer zu bearbeitenden fläche und grünflächenbearbeitungssystem |
CN111174758B (zh) * | 2020-01-18 | 2021-07-16 | 湖南工学院 | 一种机器人无信号地形探测的方法 |
US11945439B2 (en) | 2020-02-27 | 2024-04-02 | Volvo Truck Corporation | AD or ADAS aided maneuvering of a vehicle |
CN116400694A (zh) * | 2020-06-28 | 2023-07-07 | 苏州宝时得电动工具有限公司 | 自移动设备 |
US20220305658A1 (en) * | 2021-03-29 | 2022-09-29 | Husqvarna Ab | Operation for a Robotic Work Tool |
SE545830C2 (en) * | 2021-05-03 | 2024-02-13 | Husqvarna Ab | System and method for operating a robotic work tool in a first and a second work area |
US20230217215A1 (en) * | 2021-12-30 | 2023-07-06 | Motorola Mobility Llc | Environment Dead Zone Determination based on UWB Ranging |
CN115291613A (zh) * | 2022-09-16 | 2022-11-04 | 未岚大陆(北京)科技有限公司 | 自主移动设备及其控制方法和计算机可读存储介质 |
CN115309167B (zh) * | 2022-09-16 | 2023-08-01 | 未岚大陆(北京)科技有限公司 | 自主移动设备及其控制方法和计算机可读存储介质 |
CN115421497A (zh) * | 2022-09-26 | 2022-12-02 | 追觅创新科技(苏州)有限公司 | 定位信号遮挡区域规避方法 |
CN118605488A (zh) * | 2023-02-28 | 2024-09-06 | 苏州宝时得电动工具有限公司 | 一种建图控制方法、建图方法、装置和移动设备 |
WO2024179481A1 (zh) * | 2023-02-28 | 2024-09-06 | 苏州宝时得电动工具有限公司 | 自移动设备及控制方法、自主工作系统 |
CN117249834B (zh) * | 2023-11-17 | 2024-01-30 | 未岚大陆(北京)科技有限公司 | 路径规划方法、装置、设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101126808A (zh) * | 2007-08-02 | 2008-02-20 | 中国科学院自动化研究所 | 一种机器人导航系统及导航方法 |
CN101867868A (zh) * | 2010-03-26 | 2010-10-20 | 东南大学 | 一种组合导航装置和实施方法 |
CN102913275A (zh) * | 2012-11-01 | 2013-02-06 | 金纯� | 一种基于爬虫机器人的搜救系统 |
CN104184781A (zh) * | 2013-05-28 | 2014-12-03 | 东北大学 | 面向未知环境探测的移动机器人自部署感知网络 |
US20150312774A1 (en) * | 2014-04-25 | 2015-10-29 | The Hong Kong University Of Science And Technology | Autonomous robot-assisted indoor wireless coverage characterization platform |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5944132A (en) | 1995-07-20 | 1999-08-31 | Golfpro International, Inc. | Method and apparatus for controlling robotic golf caddy apparatus |
US6611738B2 (en) | 1999-07-12 | 2003-08-26 | Bryan J. Ruffner | Multifunctional mobile appliance |
US7076365B2 (en) * | 2003-05-12 | 2006-07-11 | Circumnav Networks, Inc. | Enhanced dead reckoning method |
US8874261B2 (en) * | 2007-07-25 | 2014-10-28 | Deere & Company | Method and system for controlling a mobile robot |
KR101543490B1 (ko) | 2008-04-24 | 2015-08-10 | 아이로보트 코퍼레이션 | 로봇 가능화 모바일 제품을 위한 위치 측정 시스템, 위치 결정 시스템 및 운전 시스템의 적용 |
CN101403620B (zh) * | 2008-09-10 | 2013-04-24 | 深圳市同洲电子股份有限公司 | 导航装置及方法 |
US8306726B2 (en) * | 2009-04-28 | 2012-11-06 | Caterpillar Inc. | Position monitoring system for a mobile machine |
IT1401368B1 (it) * | 2010-07-28 | 2013-07-18 | Active Srl | Metodo e sistema per il controllo di un dispositivo robotizzato semovente |
CN101950027A (zh) * | 2010-08-18 | 2011-01-19 | 东莞市泰斗微电子科技有限公司 | 一种导航卫星信号接收模块及用于该模块的信息处理方法 |
WO2013065042A1 (en) * | 2011-11-02 | 2013-05-10 | Ronen Shai | Generating and using a location fingerprinting map |
US9097536B2 (en) * | 2012-02-02 | 2015-08-04 | Mcube, Inc. | Indoor navigation techniques to calibrate/recalibrate inertial sensors and navigation processing |
CN102645222B (zh) * | 2012-04-10 | 2015-07-22 | 惠州市德赛西威汽车电子有限公司 | 一种卫星惯性导航方法 |
US8898002B2 (en) * | 2012-11-27 | 2014-11-25 | Cloudcar, Inc. | Geographical location aggregation from multiple sources |
WO2015072897A1 (en) * | 2013-11-12 | 2015-05-21 | Husqvarna Ab | Improved navigation for a robotic working tool |
KR20160139019A (ko) * | 2014-03-28 | 2016-12-06 | 얀마 가부시키가이샤 | 자율 주행 작업 차량 |
US9977133B2 (en) * | 2014-08-26 | 2018-05-22 | Verizon Patent And Licensing Inc. | Radio access network service-assisted, sensor based indoor navigation |
WO2016097891A1 (en) | 2014-12-18 | 2016-06-23 | Husqvarna Ab | Robotic vehicle for detecting gps shadow zones |
SE540131C2 (en) | 2014-12-24 | 2018-04-10 | Husqvarna Ab | Robotic work tool with trajectory correction |
CN105044757A (zh) * | 2015-06-29 | 2015-11-11 | 中国矿业大学 | 卫星信号遮蔽区域gnss差分与惯性测量组合测图方法 |
CN105182391A (zh) * | 2015-09-24 | 2015-12-23 | 深圳市华颖泰科电子技术有限公司 | 一种高精度车载导航定位系统及方法 |
US10514261B2 (en) * | 2016-04-11 | 2019-12-24 | Hrl Laboratories, Llc | Gyromagnetic geopositioning system |
EP3174328B1 (en) * | 2015-11-24 | 2018-08-29 | Advanced Digital Broadcast S.A. | System and method for radio signal coverage mapping |
CN112731945B (zh) * | 2016-04-12 | 2024-04-12 | 苏州宝时得电动工具有限公司 | 自动工作系统,自移动设备及其控制方法 |
-
2017
- 2017-04-12 CN CN202110178134.2A patent/CN112731945B/zh active Active
- 2017-04-12 WO PCT/CN2017/080313 patent/WO2017177929A1/zh active Application Filing
- 2017-04-12 EP EP21215625.1A patent/EP3998452B1/en active Active
- 2017-04-12 CN CN201710237676.6A patent/CN107291077B/zh active Active
- 2017-04-12 EP EP23219414.2A patent/EP4339729A3/en active Pending
- 2017-04-12 EP EP17781905.9A patent/EP3444565B1/en active Active
- 2017-04-12 DE DE17781905.9T patent/DE17781905T1/de active Pending
-
2018
- 2018-10-11 US US16/157,906 patent/US11442466B2/en active Active
-
2022
- 2022-09-13 US US17/943,503 patent/US11841710B2/en active Active
-
2023
- 2023-11-10 US US18/388,704 patent/US20240077885A1/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101126808A (zh) * | 2007-08-02 | 2008-02-20 | 中国科学院自动化研究所 | 一种机器人导航系统及导航方法 |
CN101867868A (zh) * | 2010-03-26 | 2010-10-20 | 东南大学 | 一种组合导航装置和实施方法 |
CN102913275A (zh) * | 2012-11-01 | 2013-02-06 | 金纯� | 一种基于爬虫机器人的搜救系统 |
CN104184781A (zh) * | 2013-05-28 | 2014-12-03 | 东北大学 | 面向未知环境探测的移动机器人自部署感知网络 |
US20150312774A1 (en) * | 2014-04-25 | 2015-10-29 | The Hong Kong University Of Science And Technology | Autonomous robot-assisted indoor wireless coverage characterization platform |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11073828B2 (en) * | 2017-12-08 | 2021-07-27 | Samsung Electronics Co., Ltd. | Compression of semantic information for task and motion planning |
JPWO2019180765A1 (ja) * | 2018-03-19 | 2020-12-10 | 本田技研工業株式会社 | 自律走行作業機 |
EP3770712A4 (en) * | 2018-03-19 | 2021-07-21 | Honda Motor Co., Ltd. | AUTONOMOUS DRIVING MACHINE |
JP7003224B2 (ja) | 2018-03-19 | 2022-01-20 | 本田技研工業株式会社 | 自律走行作業機 |
US11714411B2 (en) | 2018-03-19 | 2023-08-01 | Honda Motor Co., Ltd. | Autonomous traveling work machine |
JP2020009414A (ja) * | 2018-06-28 | 2020-01-16 | パナソニックIpマネジメント株式会社 | 移動ロボット、及び、制御方法 |
JP7262076B2 (ja) | 2018-06-28 | 2023-04-21 | パナソニックIpマネジメント株式会社 | 移動ロボット、及び、制御方法 |
US20210116581A1 (en) * | 2019-10-22 | 2021-04-22 | Neutron Holdings, Inc. Dba Lime | Leveraging operations depots for antenna placement to gather phase and position data |
US11693123B2 (en) * | 2019-10-22 | 2023-07-04 | Neutron Holdings, Inc. | Leveraging operations depots for antenna placement to gather phase and position data |
Also Published As
Publication number | Publication date |
---|---|
CN112731945B (zh) | 2024-04-12 |
CN107291077B (zh) | 2021-03-16 |
EP3998452A1 (en) | 2022-05-18 |
EP3998452B1 (en) | 2023-12-27 |
US20190041869A1 (en) | 2019-02-07 |
CN112731945A (zh) | 2021-04-30 |
EP3444565B1 (en) | 2022-01-26 |
EP3444565A4 (en) | 2019-12-04 |
US11442466B2 (en) | 2022-09-13 |
EP4339729A2 (en) | 2024-03-20 |
DE17781905T1 (de) | 2019-06-19 |
EP3444565A1 (en) | 2019-02-20 |
US20240077885A1 (en) | 2024-03-07 |
US11841710B2 (en) | 2023-12-12 |
US20230004172A1 (en) | 2023-01-05 |
EP4339729A3 (en) | 2024-05-08 |
CN107291077A (zh) | 2017-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2017177929A1 (zh) | 自动工作系统自移动设备及其控制方法 | |
US20210227744A1 (en) | Automatic Working System, Self-Moving Device And Control Method Thereof | |
US10646997B2 (en) | Navigation for a robotic working tool | |
US20200191973A1 (en) | Navigation for a Robotic Work Tool | |
US10136576B2 (en) | Navigation for a robotic working tool | |
CN108226965B (zh) | 自移动设备的定位故障处理方法、装置和电子设备 | |
EP3384318B1 (en) | Improved navigation for a vehicle by implementing two operating modes | |
EP3084542B1 (en) | System and method for navigating a robotic working tool. | |
WO2017092798A1 (en) | Improved navigation for a robotic work tool |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2017781905 Country of ref document: EP |
|
ENP | Entry into the national phase |
Ref document number: 2017781905 Country of ref document: EP Effective date: 20181112 |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17781905 Country of ref document: EP Kind code of ref document: A1 |