WO2021058030A1 - Self-moving device and control method therefor, and automatic working system - Google Patents

Self-moving device and control method therefor, and automatic working system Download PDF

Info

Publication number
WO2021058030A1
WO2021058030A1 PCT/CN2020/118898 CN2020118898W WO2021058030A1 WO 2021058030 A1 WO2021058030 A1 WO 2021058030A1 CN 2020118898 W CN2020118898 W CN 2020118898W WO 2021058030 A1 WO2021058030 A1 WO 2021058030A1
Authority
WO
WIPO (PCT)
Prior art keywords
boundary
mobile device
self
positioning
processing
Prior art date
Application number
PCT/CN2020/118898
Other languages
French (fr)
Chinese (zh)
Inventor
何明明
Original Assignee
苏州宝时得电动工具有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 苏州宝时得电动工具有限公司 filed Critical 苏州宝时得电动工具有限公司
Publication of WO2021058030A1 publication Critical patent/WO2021058030A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present invention relates to a self-mobile device, and in particular, to a control method of a self-mobile device, a self-mobile device adopting the control method, an automatic working system, a computer-readable storage medium, a computer program product, and an electronic device.
  • the purpose of the base station is to provide real-time observations of some satellites of the receiving station.
  • the receiving station uses its own observation values to calculate positioning data using RTK technology. High-precision positioning is achieved through data differential correction, and the position coordinates of the automatic lawn mower are obtained. This technology can achieve stable, long-term high-precision absolute positioning.
  • the base station can be a self-built base station or a shared base station. However, no matter what kind of base station is used, for home users, the base station needs to be purchased and installed, which is costly and difficult.
  • the present invention provides a method for realizing self-mobile equipment control under the condition of using virtual base stations for positioning and self-mobile equipment using the control method to solve the cumulative error caused by the use of virtual base stations.
  • the present invention provides a control method for self-mobile equipment, which includes the steps:
  • S102 Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
  • S103 Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point, and control the self-movement when the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold
  • the device stops processing the boundary area, wherein the cumulative error measurement value is the value of the time since the mobile device left the positioning calibration point, or the value of the movement distance since the mobile device left the positioning calibration point, wherein the position of the positioning calibration point It is the position of the charging station or the position with fixed coordinates set in the working area;
  • the method further includes the following steps:
  • the boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing work is the distance between the mapping boundary and the maximum inner boundary, or the boundary information includes distinguishing the working area and the maximum inner boundary.
  • the boundary line of the non-working area, the processing width range of the boundary area processing work is 70cm-90cm from the boundary line to the working area, and the processing width of the boundary area processing work is the set safety distance and setting The sum of cumulative error thresholds;
  • S301 Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
  • S302 Control the mobile device to return to the waiting area for work
  • S303 Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
  • the present invention provides a control method for self-mobile equipment, which includes the steps:
  • S102 Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
  • the cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point.
  • the position of the positioning calibration point is a charging station position or a position with fixed coordinates set in a working area.
  • the method further includes the following steps:
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
  • the boundary information includes a mapping boundary and a maximum inner boundary
  • the processing width range of the boundary region processing task is the distance between the mapping boundary and the maximum inner boundary
  • the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
  • processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
  • the method further includes:
  • S301 Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
  • S302 Control the mobile device to return to the waiting area for work
  • S303 Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
  • the present invention also provides a self-moving device, which includes:
  • the moving module is used to drive the housing to move
  • Task execution module used to perform work tasks
  • a control module which is electrically connected to the mobile module and the task execution module, controls the mobile module to drive the mobile device to move, and controls the task execution module to perform work tasks;
  • the self-moving device further includes:
  • a boundary information acquisition module for acquiring boundary information, the control module controls the mobile device to move on the boundary after leaving the positioning calibration point after completing calibration at a positioning calibration point, and processing the boundary area;
  • a cumulative error measurement value acquisition module configured to obtain a cumulative error measurement value, and the control module controls the mobile device to stop the boundary area processing work when the cumulative error measurement value reaches a set cumulative error threshold;
  • the positioning quality value acquisition module is used to acquire the positioning quality value, and the control module controls the mobile device to stop the boundary area processing work when the positioning quality value reaches the set positioning quality threshold.
  • the cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point.
  • the position of the positioning calibration point is a charging station position or a position with fixed coordinates set in a working area.
  • the self-moving device includes:
  • the boundary processing judgment module is used to judge whether the self-mobile device has completed the preset task.
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
  • the boundary information includes a mapping boundary and a maximum inner boundary
  • the processing width range of the boundary region processing task is the distance between the mapping boundary and the maximum inner boundary
  • the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
  • processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold of the mobile device.
  • the self-moving device includes:
  • the working area judging module is used to judge whether the self-mobile device has a working area, and when there is a working area, the control module controls the self-mobile device to stop the boundary area processing work and then return to the working area to work;
  • the regression judgment module is used to judge whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point, and when the preset condition of returning to a positioning calibration point is satisfied, the control module controls the self-mobile device to return to a positioning from the working area Calibration point.
  • the present invention also provides an automatic working system, which includes:
  • the present invention also provides a computer-readable storage medium on which a computer program is stored, and when the computer program instructions are executed by a computing device, the computer program instructions are operable to execute the above-mentioned control method of a mobile device.
  • the present invention also provides a computer program product.
  • the instructions in the computer program product are executed by a processor, the above-mentioned self-mobile device control method is executed.
  • the present invention also provides an electronic device, including:
  • Memory for storing computer executable instructions
  • the processor is configured to execute computer-executable instructions stored in the memory to execute the control method of the self-mobile device as described above.
  • the present invention can make full use of the time period when the positioning accuracy is highest since the mobile device starts to process the boundary first, improve the efficiency of boundary processing and the effect of boundary processing, and solve the problem of unsatisfactory boundary processing caused by accumulated errors. problem.
  • Fig. 1 is a schematic diagram of an automatic working system in an embodiment of the present invention.
  • Fig. 2 is a schematic diagram of working in a working area when the self-mobile device is a smart lawn mower in an embodiment of the present invention.
  • Fig. 3 is a schematic diagram of an automatic working system including two sub-working areas in an embodiment of the present invention.
  • Fig. 4 is a schematic diagram of a simulation of boundary processing of a self-mobile device with accumulated positioning errors.
  • Fig. 5 is a schematic flowchart of the control method of a mobile device according to the present invention.
  • Fig. 6 is a schematic flow chart of a positioning method from a mobile device according to the present invention.
  • FIG. 7 is a schematic flowchart of a method for obtaining a reference positioning signal when the mobile device includes multiple reference positioning signals according to the present invention.
  • FIG. 8 is a schematic diagram of the movement path of the first behavior logic in the control method of the self-mobile device of the present invention.
  • FIG. 9 is a schematic diagram of the movement path of the second behavior logic in the control method of the self-mobile device of the present invention.
  • FIG. 10 is a schematic flow diagram of a single complete boundary processing in the first behavior logic in the control method of the self-mobile device of the present invention.
  • FIG. 11 is a schematic flowchart of the complete boundary processing of N circumferential movement paths in the first behavior logic in the control method of the self-mobile device of the present invention.
  • FIG. 12 is a schematic diagram of a complete boundary processing movement path of N circumferential movement paths in the method for controlling a self-moving device of the present invention.
  • FIG. 13 is a schematic flowchart of a single complete boundary processing in the second type of behavior logic in the control method of the self-mobile device of the present invention.
  • FIG. 14 is a schematic flowchart of the complete boundary processing of N circumferential movement paths in the second behavior logic in the control method of the self-mobile device of the present invention.
  • Fig. 15 is a schematic diagram of the structure of a mobile device of the present invention.
  • Fig. 16 is a schematic structural diagram of a positioning structure used in a mobile device of the present invention.
  • FIG. 17 is a schematic block diagram of an electronic device according to an embodiment of the present invention.
  • Location determination module 600 electronic equipment 610, processor
  • error data refers to an error message obtained after analyzing two sets of satellite signals with a common number of satellites, and the error message is used for subsequent positioning of the mobile device.
  • Error evaluation refers to the evaluation of the accuracy of the location information of the self-mobile device during the movement of the self-mobile device, analysis of the accuracy or error rate of the positioning, and error evaluation to avoid the self-mobile device from following the wrong direction. Keep moving.
  • Border not only refers to the boundary between the work area and the non-work area, such as the boundary between the lawn and the lawn, but also refers to the boundary between the workable area and the non-workable area formed around obstacles in the work area, such as Obstacles can be trees, islands, etc.
  • Boundary information refers to information that characterizes the boundary features, such as the location of the boundary, which is helpful to the mobile device.
  • Boundary area processing work refers to the activities of processing the boundary, which can include mowing, cleaning, watering, snow removal, etc.
  • Fig. 1 is a schematic diagram of an automatic working system 100 according to a first embodiment of the present invention.
  • the automatic working system 100 in the embodiment of the present invention includes a self-moving device.
  • Self-mobile devices can move and work within the work area defined by the map.
  • the self-moving equipment is an automatic lawn mower 1.
  • the self-moving equipment may also be equipment suitable for unattended operation, such as automatic cleaning equipment, automatic watering equipment, and automatic snowplow.
  • the automatic lawn mower 1 includes a housing 3, a mobile module 5, a task execution module 7, an energy module, a control module, and the like.
  • the working place of the automatic lawn mower 1 is the lawn 6.
  • the moving module 5 includes a crawler belt or a wheel set, which is driven by a driving motor to drive the automatic lawn mower 1 to move.
  • the task execution module 7 includes a cutting assembly, which is installed at the bottom of the housing 3 and is driven by a cutting motor to rotate and perform the mowing work.
  • the energy module includes a battery pack (not shown) to provide electrical energy for the movement and operation of the automatic lawn mower 1.
  • the control module is electrically connected to the mobile module 5, the task execution module 7 and the energy module, controls the mobile module to drive the automatic lawn mower 1 to move, and controls the task execution module to perform work tasks.
  • the automatic working system is used to work in a predetermined working area.
  • the working area includes at least two mutually separated sub-working areas, namely, area C and area D.
  • a boundary 8 is formed between the working area and the non-working area, and there may be obstacles in the working area, such as trees, pits, etc.
  • the automatic working system 100 further includes a charging station 2 for supplying electric power to the automatic lawn mower 1.
  • the charging station 2 can be set in an open place beside the house 4.
  • the charging station 2 can also be located in the work area or on the boundary of the work area.
  • the automatic working system 100 includes a navigation module for outputting the current position of the automatic lawn mower.
  • the navigation module includes a mobile station 9.
  • the mobile station 9 is electrically connected with the control module to store and process the satellite signals obtained by the automatic lawn mower 1, so that the automatic lawn mower 1 can move and work in the working area.
  • the mobile station 9 is used to receive satellite signals, and the satellite signals include satellite angles, clocks, and so on.
  • the satellite signal can be a GPS signal, Galileo, Beidou, etc., or several signals can be used at the same time.
  • the satellite signal is a differential GPS (DGPS) signal.
  • DGPS differential GPS
  • the navigation module While the navigation module outputs position information, it can also output the accuracy level of the positioning signal.
  • the automatic lawn mower 1 can also determine the current positioning state according to the position information output by the navigation module, and output a positioning state indication.
  • the basis for judging the quality of the location information output by the navigation module can be the number of satellites that the navigation module can receive signals, or the positioning status indicator, or the accuracy factor, or a combination of multiple factors, setting the importance weight to obtain the location information quality .
  • the quality of the location information output by the navigation module can be evaluated by the navigation module itself for error, and the control module can obtain the evaluation result, or the control module can use the output of the navigation module for error evaluation to obtain the evaluation result.
  • the automatic lawn mower 1 further includes at least one position sensor, which is electrically connected to the control module, and detects features related to the position of the automatic lawn mower 1.
  • Position sensors can include cameras, radars, capacitive sensors, inertial navigation sensors, and so on.
  • the position sensor is an inertial navigation sensor.
  • the inertial navigation sensor may include an accelerometer, an odometer, a compass, a gyroscope, a posture detection sensor, etc., to detect the speed, acceleration, and driving direction of the mobile device.
  • the control module at least partly determines the current location of the automatic lawn mower 1 based on the output of the location sensor.
  • the position information output by the navigation module and the output of the position sensor can be fused to obtain the current position of the automatic lawn 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 navigation module meets the 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 a high-precision output.
  • the mobile station 9 when the mobile station 9 is working, it can only use GPS positioning signals for navigation, or use GPS positioning signals and inertial navigation data fusion processing positioning signals for navigation, or when the GPS signal is weak , You can also use only inertial navigation data to navigate.
  • the mobile station 9 may also include an indicator (not shown) to output an indication of whether the differential GPS signal of the current position is good.
  • the mobile station 9 is detachably connected to the housing 3 of the automatic lawn mower 1.
  • the mobile station 9 includes a first interface (not shown) connected to the housing of the automatic lawn mower 1.
  • the mobile station 9 is installed on the housing 3 of the automatic lawn mower 1.
  • the mobile station 9 can realize the electrical connection with the control module of the automatic lawn mower 1.
  • the mobile station 9 outputs the current position coordinates of the automatic lawn mower 1, and the control module according to the automatic cutting
  • the current position of the lawn mower 1 controls the movement and work of the automatic lawn mower 1.
  • the mobile station outputs a control command to the control module according to the current position coordinates.
  • the mobile station 9 includes an independent power supply module (not shown in the figure). When the mobile station 9 is separated from the housing 3 of the automatic lawn mower 1, it can work independently. In other embodiments, the mobile station 9 and the housing 3 of the automatic lawn mower 1 may be non-detachable connection. If it is positioned during the operation of the mobile device, the mobile station 9 and the housing 3 of the automatic lawn mower 1 3 Whether it is detachable does not affect the positioning.
  • the mobile station 9 obtains error data by using the reference positioning signal before the current positioning signal and obtains the current position information based on the error data and the position information processing of the reference positioning signal. It does not use a self-built base station or a shared base station to receive it in real time at the current moment.
  • the satellite signal is processed to obtain current location information, so self-built base stations or shared base stations can be eliminated, which simplifies user installation and greatly reduces costs.
  • the positioning method of a self-mobile device without a self-built base station or a shared base station is configured as a positioning apparatus of the self-mobile device for illustration.
  • the positioning device of the mobile device in this embodiment may be set in the server, or may also be set in the mobile station, which is not limited in the embodiment of the present application.
  • the electronic device is, for example, a personal computer (PC), a cloud device or a mobile device
  • the mobile device is, for example, a smart phone or a tablet computer.
  • execution subject of the embodiments of the present application may be, for example, a server or a central processing unit (CPU) in an electronic device in hardware, and may be, for example, a server or background management in an electronic device in software. Service, there is no restriction on this.
  • Self-built base stations or shared base stations can provide real-time satellite signals for positioning to self-mobile devices as reference positioning signals.
  • the positioning error is considered to be a constant value or the error difference is relatively small from the perspective of the satellite signal.
  • the present invention uses a virtual base station, that is, does not set any self-built base station or shared base station that can obtain real-time satellite signals, and only uses the satellite signal obtained at a certain time point at a certain positioning calibration point as the reference positioning signal for subsequent positioning. For example, the satellite signal obtained before the departure of the mobile device is used as the reference positioning signal for subsequent positioning.
  • the positioning error is a cumulative error, and the error will gradually become larger, that is, with the accumulation of time, if you only use positioning navigation for positioning without using other positioning equipment, the positioning will become more and more inaccurate . Therefore, the self-mobile device will set an error evaluation. When the error exceeds the set error threshold, the self-mobile device will be controlled to return to the positioning calibration point to re-acquire the satellite signal of the positioning calibration point.
  • the satellite signal is a new positioning signal.
  • the reference positioning signal is a new positioning signal.
  • the automatic lawn mower 1 has a mapping boundary 901 acquired by mapping.
  • the boundary can be obtained by a user's hand-held navigation device walking around the boundary of the working area.
  • the positioning error (which may be accumulated positioning The error can also be a constant positioning error).
  • a buffer with the self-built map boundary 901 reduced inward by a certain distance is set, and the boundary formed by reducing a certain distance inward is Buffer boundary 902, but the automatic lawn mower 1 has a positioning error.
  • the positioning error Combined with the positioning error, it has a maximum inner boundary 903.
  • the maximum inner boundary 903 is the innermost position of the automatic lawn mower 1 when it moves along the boundary.
  • Fig. 5 is a schematic flowchart of a control method from a mobile device of the present invention. As shown in FIG. 5, the control method of the self-mobile device includes step S101 to step S104.
  • Step S101 Obtain boundary information on the work area map.
  • the boundary information may be obtained from a map of the working area stored in the mobile device, and the boundary in the map may be obtained by positioning the user's handheld navigation device walking around the boundary of the working area.
  • Step S102 Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing.
  • the positioning calibration point is moved to the boundary.
  • Step S103 Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point.
  • the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold, control the self The mobile device stops processing the boundary area.
  • the mobile device does not use a physical base station for positioning, but uses a virtual base station for positioning.
  • the virtual base station is not an actual base station. Instead, a special point is selected as the positioning calibration point, and the positioning calibration point is used as a base station.
  • the position of the virtual base station is the set positioning calibration point position, that is, the aforementioned positioning calibration Point position, so the reference positioning signal is obtained from the mobile device directly from the satellite instead of being obtained in real time through the physical base station.
  • the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area.
  • the positioning method using a virtual base station is as follows: the current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information .
  • the cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point. That is, the cumulative error measurement value can be time data or distance data.
  • the corresponding cumulative error threshold is a time threshold or a distance threshold. The following further describes the solutions for the two cumulative error measurement values and the corresponding cumulative error threshold.
  • the cumulative error threshold value is a time threshold value. Therefore, for step S103, the cumulative error measurement value obtained during the movement of the mobile device, when the cumulative error measurement value reaches the set cumulative error threshold, controlling the mobile device to stop the processing of the boundary area, which specifically includes:
  • the cumulative error threshold value is a distance threshold value. Therefore, for step S103, the cumulative error measurement value obtained during the movement of the mobile device, when the cumulative error measurement value reaches the set cumulative error threshold, controlling the mobile device to stop the boundary area processing work includes:
  • the mobile device When the sum of the distance value B1 and the distance value B2 reaches the set distance threshold, the mobile device is controlled to stop the boundary area processing.
  • the positioning quality value in step S103 specifically includes the following steps:
  • the error in the initial time period after the mobile device leaves from the positioning calibration point is relatively small, so the positioning accuracy is high.
  • the control method of the self-moving device of the present invention makes full use of the self-moving The boundary is processed first in the time period with the highest positioning accuracy after the device is set off, which improves the efficiency of boundary processing and the effect of boundary processing, and solves the problem of unsatisfactory boundary processing caused by accumulated errors.
  • step S103 if the cumulative error threshold is the positioning quality threshold, it is necessary to compare the positioning quality information during the movement of the self-mobile device with the set positioning quality threshold to determine whether the self-mobile device is To meet the positioning quality threshold requirements, at the same time, when the mobile device is moving, whether it is processing the boundary area or the working area, it needs to determine the position, so the method for determining the position of the mobile device based on the virtual base station specifically includes the steps S201 to step S203.
  • Step 201 Acquire the current positioning signal from the mobile device during the movement, and the reference positioning signal from the mobile device before the current positioning signal.
  • the self-moving device may be, for example, the mobile station 9 or the self-moving device itself with the mobile station 9 installed, and there is no restriction on this.
  • the current positioning signal may be the current positioning signal during the operation of the mobile device.
  • the current positioning signal may also be the current positioning signal in the process of generating the map.
  • the generated map can be used as the working area of the mobile device, and there is no restriction on this. It is understandable that the way of generating the map can be, for example, the user encircles the working area of the mobile device on the Google map, the mobile station 9 is integrated with the mobile device, and the mobile device is the mobile device.
  • the self-moving device runs a circle along the work area.
  • the self-moving device is an automatic lawn mower
  • the user can push the automatic lawn mower to run, and the user remotely controls the operation of the automatic lawn mower, and the automatic lawn mower follows the trajectory of the user's movement.
  • the automatic operation of the automatic lawn mower etc.
  • the mobile station 9 is separated from the automatic lawn mower, and the mobile device is the mobile station 9.
  • the user holds the mobile station 9 and runs a circle along the work area, and generates a map based on the positioning signal data collected during the operation of the mobile station 9.
  • the reference positioning signal is directly collected from a satellite by a mobile device, rather than a synchronous satellite signal transmitted by a self-built base station or a shared base station.
  • the reference positioning signal can be obtained in two ways. The first is to directly use the satellite signal obtained at the position of the positioning calibration point as the reference positioning signal; the second is to first use the satellite signal received at the latest time before the current time as the reference positioning signal. Solution processing, if the solution condition is not met, continue to select the satellite signal received at a previous moment as the reference positioning signal for solution processing, and so on until the satellite signal that meets the solution condition is obtained as the reference positioning signal.
  • the method further includes the step of determining the positioning calibration point The reference coordinates of the position; the positioning signal obtained from the mobile device at the position of the positioning calibration point, the positioning signal is used as the first reference positioning signal.
  • the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area.
  • the positioning calibration point For the identification of the position of the positioning calibration point, if the positioning calibration point is a charging station, it can be directly recognized through the charging docking that the mobile device has reached the positioning calibration point, and the reference positioning signal of the positioning calibration point position can be obtained. The positioning of the calibration point can be confirmed by setting the marking signal, such as magnetic field or image, etc.
  • the self-mobile device is described as the automatic lawn mower 1.
  • the reference positioning signal includes one
  • the reference positioning signal can be selected to obtain the satellite signal of the positioning calibration point at the preset positioning calibration point.
  • the position of the positioning calibration point here is the position of the charging station or the position with fixed coordinates set in the working area.
  • the selected positioning calibration point with fixed reference coordinates or an object or stopping point with fixed coordinates is used as the positioning calibration point.
  • the charging station or the positioning calibration point with fixed reference coordinates is used as the virtual base station point, because the charging station or the positioning calibration point with fixed reference coordinates can be regarded as a non-compliance.
  • the physical location will change, so the charging station or the positioning calibration point with fixed reference coordinates is used as a virtual base station point.
  • the charging station because the automatic lawn mower 1 starts from the charging station every time, and will eventually connect to the charging station, it can be considered that the charging station is a physical location that will not change, so the charging station is regarded as a Virtual base station point.
  • the automatic lawn mower 1 Before the automatic lawn mower 1 works, it saves the satellite signal received at the current charging station position as virtual base station data in the mobile station 9 as a reference positioning signal.
  • the satellite signal received at the position of the positioning calibration point at that time is stored in the mobile station 9 as virtual base station data. As a reference positioning signal.
  • the first reference positioning signal is obtained by acquiring the satellite signal of the positioning calibration point at the preset positioning calibration point, and the other reference positioning signals are automatic
  • the satellite signal of the specific position obtained by the lawn mower 1 during the movement is stored and obtained, that is, the satellite signal obtained and stored within the moving range of the automatic lawn mower 1 before the current position.
  • the method for obtaining the reference positioning signal includes:
  • S301 Select the acquired satellite signal at the latest time before the current positioning signal as the reference positioning signal
  • step S304 Repeat step S303 until a reference positioning signal that meets the solution condition is obtained.
  • the solution condition is: the number of shared satellites reaches a set threshold for the number of solution satellites. Further. Alternatively, the solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signals reaches the set signal-to-noise ratio threshold. It can be seen from the above description that the mobile device preferentially selects the reference positioning signal that is closest in time and meets the solution requirements for solution processing.
  • the charging station or the positioning calibration point with fixed reference coordinates is preferably set in a relatively open environment to receive relatively good satellite signals.
  • the above-mentioned virtual base station data may be the obtained original satellite signal or the processed satellite signal. Whether it is the original satellite signal or the processed satellite signal, it will not affect the subsequent signal processing.
  • the reference positioning signal can be selected to obtain the satellite signal of the positioning calibration point at the preset positioning calibration point.
  • the position of the positioning calibration point here is the position of the charging station or the position with fixed coordinates set in the working area.
  • the selected positioning calibration point with fixed reference coordinates or an object or stopping point with fixed coordinates is used as the positioning calibration point.
  • the charging station taking the charging station as an example, the user starts from the charging station and saves the satellite signal received at the current charging station location as virtual base station data in the mobile station 9 as a reference positioning signal.
  • the positioning calibration point with fixed reference coordinates similarly, the user starts from the positioning calibration point and saves the satellite signal received at the position of the positioning calibration point as virtual base station data in the mobile station 9 as a reference positioning signal .
  • the first reference positioning signal is obtained by acquiring the satellite signal of the positioning calibration point at the preset positioning calibration point, and the other reference positioning signals are the user's handheld mobile
  • the satellite signal of the specific position obtained during the movement of the station 9 is stored and obtained, that is, the satellite signal obtained and stored within the moving range of the mobile station 9 before the current position.
  • the user When the user is traveling, the user can directly walk to the position of the positioning calibration point and use the position coordinates of the positioning calibration point as the current position coordinates, which can improve the positioning accuracy and thus the accuracy of the generated map.
  • Step 202 Perform calculation processing on the reference positioning signal and the current positioning signal to obtain error data, and the reference positioning signal subjected to the calculation processing and the current positioning signal have a common satellite signal.
  • the solution processing cannot be performed.
  • the mobile device moves, if the shared satellite signal is still not available under preset conditions, Since the mobile device needs to return to the positioning calibration point to obtain a new reference positioning signal.
  • the self-mobile device is a self-mobile device, the self-mobile device can return to the positioning calibration point position by itself. If the self-mobile device is a mobile station 9, the user needs to be reminded to return to the positioning calibration point. The way to remind the user can be alarm or shutdown, etc. .
  • the preset condition may be the preset time when the shared satellite is lost or the time when the solution cannot be performed.
  • a threshold for the number of satellites to be solved is preset. For the case where there is only one reference positioning signal, when the number of shared satellites reaches the set threshold of the number of resolved satellites, the reference positioning signal and the current positioning signal are subjected to calculation processing. When the number of shared satellites does not reach the set threshold for solving satellites, as the mobile device moves, if the shared satellite signal is still not available under preset conditions, the mobile device returns to the positioning calibration point to obtain a new one. Reference positioning signal.
  • the number of satellites to be solved is at least 7-8. If the number of satellites is too small, it will not be possible to perform the calculation process to obtain position information. Of course, the number of satellites can not be too many. increase. In one embodiment, the number of satellites to be solved is 13-14, the number of satellites in this range meets the requirements of the solution, and the computing power supported by hardware and software of general mobile devices can solve satellite computing without high cost. .
  • the reference positioning signal selected for the solution processing is the satellite signal obtained before the current time and the closest to the current time, and the reference positioning signal with a large number of shared satellites is preferentially selected for the solution processing .
  • the reference positioning signal and all satellites The current positioning signal is solved for processing.
  • other reference positioning signals before the time are selected for the analysis of the number of shared satellites, until the number of solved satellites is reached. The threshold value of the reference positioning signal exists, and then the solution is processed.
  • the self-mobile device If the self-mobile device still cannot obtain the shared satellite signal under the preset conditions, the self-mobile device returns to the positioning calibration point to obtain a new reference positioning signal. After the mobile device goes out to work, the satellite signal received by the mobile station 9 in real time and the reference positioning signal received by the virtual base station (that is, the charging station or the positioning calibration point with fixed reference coordinates) are processed to obtain a high-precision Positioning data. After returning to the positioning calibration point, the stored satellite signal of the virtual base station is cleared, and the satellite signal of the virtual base station at that time will be recorded as the reference positioning signal until the next work.
  • the solution condition is: the number of shared satellites reaches a set threshold for the number of solution satellites.
  • the signal quality of the satellite signal itself also needs to meet certain requirements, so the further calculation conditions are: the number of shared satellites reaches the set threshold of the number of satellites to be resolved, and the signal of the satellite signal The quality reaches the set signal-to-noise ratio threshold.
  • Step 203 According to the error data and the position information of the reference positioning signal, the current position information obtained from the mobile device is processed.
  • the control method of the self-mobile device further includes: performing error evaluation on the current position information of the self-mobile device obtained by processing; and, when the error evaluation result meets the error condition, returning from the mobile device to the positioning calibration point to re-acquire the initial The reference positioning signal.
  • the control method of the self-mobile device further includes: performing error evaluation on the current position information of the self-mobile device obtained by processing; and, when the error evaluation result meets the error condition, returning from the mobile device to the positioning calibration point to re-acquire the initial The reference positioning signal.
  • the position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device.
  • the error condition is: the working time of the mobile device reaches the set total working time threshold.
  • the error condition may also be: the selected reference positioning signal does not meet the solution condition, where the solution condition is: the number of shared satellites reaches a set threshold for the number of resolved satellites. Further, the solution condition is that the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signals reaches the set signal-to-noise ratio threshold.
  • the method of setting the error condition can be set by the following method. If the self-mobile device is a self-mobile device, the method of setting the error threshold can be: the time range value of the self-mobile device leaving the positioning calibration point, The reference positioning signal and the time range value for which the current positioning signal cannot be resolved, the specified working time range value, and the time range value for losing the shared satellite. If the mobile device is the mobile station 9, the method for setting the error threshold may be: the time range value for which the reference positioning signal and the current positioning signal cannot be resolved, the time range value for discarding the shared satellite, and so on.
  • a plurality of positioning calibration points with fixed reference coordinates are provided in the working area of the self-mobile device, and a plurality of the positioning calibration points There are known fixed reference coordinates between each other.
  • the self-mobile device uses the position information of the positioning calibration point as the current position information. For example, positioning calibration point A and positioning calibration point B shown in Figure 1 and Figure 3, when the mobile device moves to the position of the positioning calibration point, the mobile device will use the position information of the positioning calibration point as the current position information. Correct the position coordinates of the mobile device.
  • These marks can use RFID, Hall sensors, etc., by manually or automatically marking the fixed positioning calibration points to obtain a fixed reference coordinate (for example, if the charging station is (0, 0) point, physical positioning calibration The point is the (x, y) point), and each time the mobile device walks to these physical positioning calibration points, the coordinates of the physical positioning calibration point are directly used as the current coordinates.
  • a map of the work area can be constructed from the mobile device, and work efficiency can be improved by optimizing the partitioning method.
  • the specific implementation step is to divide the working area into multiple sub-areas.
  • the working mode of each area is: before the mobile device works, the current positioning calibration point, such as the satellite signal received at the charging station position, is stored as virtual base station data in the mobile device. In station 9, all satellite signals received during the work process are saved after the mobile device goes out to work. All satellite signals can be used as virtual base station data for calculation and use.
  • the base station data (including the satellite signal at the charging station and other satellite signals received and stored before the current time in the working process) is processed to obtain a high-precision positioning data. After the work is completed, return to the charging station to revise the virtual base station data, and then work in the next area.
  • error evaluation can be carried out in real time. When the area of the sub-region is still large, multiple positioning calibration points with fixed reference coordinates can also be set to correct the data to obtain higher-precision positioning data.
  • the present invention obtains the error data by using the reference positioning signal before the current positioning signal and obtains the current position information based on the error data and the position information processing of the reference positioning signal, and does not use the self-built base station or the shared base station received in real time at the current moment. Satellite signals are processed to obtain current position information, so based on the present invention, self-built base stations or shared base stations can be eliminated, user installation is simplified, and costs are greatly reduced.
  • step 101 that is, before the step of obtaining boundary information on the work area map, further includes the following steps:
  • the positioning signal obtained from the mobile device at the position of the positioning calibration point is used as the first reference positioning signal.
  • step 101 that is, before the step of obtaining boundary information on the work area map, further includes the following steps:
  • the reference coordinates of the position of the positioning calibration point are determined, the reference positioning signal is a positioning signal for positioning the position of the calibration point, and the position information of the reference positioning signal is the reference coordinate.
  • the invention uses the time period with the highest positioning accuracy to process the boundary from the mobile device, and when the processing is finished and prepares to stop the processing of the boundary area, it has two different subsequent behavior logics.
  • the two different behavior logics reflect two different boundary processing. method.
  • the first kind of behavior logic is: the mobile device processes the boundary separately, which can be performed after the processing of the work area is finished, or before the processing of the work area starts.
  • the specific logic of this behavior is to stop the boundary from the mobile device.
  • the mobile device directly returns to the position of the positioning calibration point to obtain the reference positioning signal, and then returns to the last terminated boundary position to continue moving and processing the boundary, and then repeat the relevant cumulative error threshold judgment and stop the boundary area Processing the work steps, and so on until the final completion of a complete boundary processing.
  • the self-mobile device can start from the positioning calibration point position A, move toward the boundary to reach the P1 position of the boundary.
  • the P1 position is the first cutting starting point, and move a distance along the boundary to the P2 position.
  • the mobile device stops moving and returns to the positioning calibration point position A from the P2 position to obtain the reference positioning signal again.
  • the P2 position is the first cutting end point and the second cutting start point, and it moves automatically. After reacquiring the reference positioning signal, the device re-starts from the positioning calibration point position A, returns to the P2 position and continues to move along the boundary to the P3 position.
  • the cumulative error measurement value reaches the set cumulative error threshold, the mobile device stops moving and Return to the positioning calibration point position A to obtain the reference positioning signal again.
  • the P3 position is the second cutting end point and the third cutting start point. In this way, it loops until the mobile device completes a complete boundary processing.
  • the second kind of behavior logic is that the mobile device performs boundary processing during the work process, and each time the mobile device starts from the positioning calibration point position, it will first use the time period with the highest positioning accuracy to process the boundary, and then return to the work area for routine The work of this cycle continues until the final completion of a complete boundary processing.
  • the different behavior logics are described below in conjunction with the drawings.
  • the self-mobile device can start from the positioning calibration point position A and move towards the boundary to reach the F1 position of the boundary.
  • the F1 position is the first cutting starting point, and move a certain distance along the boundary to the F2 position.
  • the mobile device completes the processing of the working area H2, and returns to the positioning calibration point position A from the end point F4 of the processing.
  • the mobile device After the mobile device returns to the positioning calibration point position A, when it is judged to be self-moving When the equipment has not completed a complete boundary processing, re-acquire the reference positioning signal at the positioning calibration point position A, move toward the boundary and reach the F2 position, and then continue to move along the boundary and process the boundary.
  • the cumulative error measurement value is judged
  • the self-mobile device stops moving, and at the same time, it is judged whether there is a waiting area, if there is a movement toward the waiting area, if not, the self-mobile device returns to the positioning calibration point position A to obtain the reference positioning signal again. Then continue to return to the end position of the boundary just now to continue boundary processing, and loop in this way until the mobile device completes a complete boundary processing.
  • FIG. 10 is a schematic diagram of the first behavior logic after the boundary region processing is stopped. After the step of controlling the mobile device to stop the processing of the boundary area, the method further includes step S401 to step S406.
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the self-mobile device has a mapping boundary 901 and a maximum inner boundary 903.
  • the result of the route planning is a spiral path.
  • the mapping boundary 901 gradually shrinks in the direction of the maximum inner boundary 903, and the spiral radius gradually decreases, or gradually expands from the maximum inner boundary 903 toward the mapping boundary 901, and the spiral radius gradually becomes larger. This processing method can ensure the maximum Border area processing.
  • the preset boundary processing path is determined according to the cutting width of the mobile device and the processing width of the boundary area processing work.
  • the cutting width is the width of the cutter head, and the processing width of the boundary area processing is the distance between the mapping boundary 901 and the maximum inner boundary 903.
  • the processing width of the boundary area processing work is less than the cutting width, then the mobile device performs a circumferential movement around the boundary.
  • the processing width of the boundary area processing work is larger than the cutting width, so the moving path of the self-mobile device is set to a spiral shape, so from the perspective of the path, the self-mobile device seems to go around the boundary N circles, but the N The circles are not concentric circles, but continuous spirals.
  • the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area
  • the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
  • the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
  • S402 Control the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning.
  • the position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S403 Control the self-locating calibration point position of the self-mobile device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
  • the last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
  • the mobile device Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
  • S405 Determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute S401; otherwise, control the mobile device to continue to move along the boundary.
  • the self-mobile device can continue to the work area for regular work, or return to the charging station position or locate the calibration point position and wait for the next work.
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the boundary area processing path can be a circumferential movement path around the boundary set based on the mapping boundary 901 and the maximum inner boundary 903. In order to achieve a better boundary processing effect, it is based on the mapping boundary 901 and the maximum inner boundary 903.
  • the relationship between the distance and the cutting width can be set with multiple circumferential moving paths.
  • the multiple circumferential moving paths may have overlapping areas.
  • the optimal solution is to have different moving paths as much as possible. This setting can ensure that the boundary The treatment effect of the area.
  • N N ⁇ 1
  • N 4.
  • N 5.
  • the direction may be different.
  • the direction of the boundary starting point during the first boundary processing is different from that of the second boundary processing.
  • the direction of the starting point of the boundary is different during boundary processing.
  • the boundary processing of the N circumferential movement paths each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing
  • the position of the boundary starting point is different from that of the second boundary processing. If it is assumed that the first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction
  • the position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different.
  • N 3, and the boundary processing of the circumferential movement path is formed by the mobile device working at different positions on the boundary.
  • the mobile device can preset the processing times threshold, and when it is learned from the mobile device that the predetermined processing times threshold has been reached, the boundary area processing task is ended.
  • step S501 after the step of stopping the processing of the boundary area from the mobile device, it further includes step S501 to step S506.
  • S501 Determine whether the self-mobile device has completed boundary processing of N circumferential movement paths, if yes, execute S506, otherwise, execute S502.
  • S502 Control the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning.
  • the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S503 Control the self-moving device to start again in the direction of the boundary from the position of the self-locating calibration point and move to the position of the last termination point, and then continue to move along the boundary.
  • the last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
  • the mobile device Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
  • S505 Determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute S501; otherwise, control the mobile device to continue to move along the boundary.
  • the self-mobile device can continue to the work area for regular work, or return to the charging station position or locate the calibration point position and wait for the next work.
  • a certain direction is taken as the starting point.
  • the self-mobile device is located at different positions on the boundary in the same direction as far as possible, that is, the self-mobile device is in different circumferences.
  • the boundary processing of the moving path they are located at different positions of the boundary in the same direction. This setting can ensure that the boundary positions in the same direction can be processed to the maximum extent, thereby improving the processing effect of the entire boundary.
  • the starting point direction on the boundary of the boundary processing of each circumferential movement path can also be different, that is, N boundary processing can have N boundary starting movement directions and N Regardless of the selection of the starting working position of the boundary, there is a processing overlap area between the N boundary processings.
  • FIG. 13 is a schematic diagram of the second behavior logic after the boundary region processing is stopped. After the step of controlling the mobile device to stop the processing of the boundary area, step 601 to step S609 are further included.
  • S601 Determine whether the self-mobile device has an area to be worked, if yes, execute S602, otherwise, execute S604.
  • the self-mobile device can return to the nearest work area for work.
  • S602 Control the mobile device to return to the waiting area for work.
  • S603 Determine whether the self-mobile device satisfies the preset condition for returning to the position of the positioning calibration point, if yes, execute S604; otherwise, control the self-mobile device to continue working.
  • the preset condition for returning to the position of the positioning calibration point is that the mobile device has completed the work in the working area or the power of the mobile device is insufficient or the error evaluation result indicates that the positioning error is large. It is necessary to reposition the calibration point position to obtain a new positioning reference Positioning signal.
  • S604 Control the self-mobile device to return to the positioning calibration point.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S605 Determine whether the self-mobile device has completed the preset task, if yes, execute S609, otherwise, execute S606.
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the self-mobile device has a mapping boundary 901 and a maximum inner boundary 903.
  • the result of the route planning is a spiral path.
  • the mapping boundary 901 gradually shrinks in the direction of the maximum inner boundary 903, and the spiral radius gradually decreases, or gradually expands from the maximum inner boundary 903 toward the mapping boundary 901, and the spiral radius gradually becomes larger. This processing method can ensure the maximum Border area processing.
  • the preset boundary processing path is determined according to the cutting width of the mobile device and the processing width of the boundary area processing work.
  • the cutting width is the width of the cutter head, and the processing width of the boundary area processing is the distance between the mapping boundary 901 and the maximum inner boundary 903.
  • the processing width of the boundary area processing work is less than the cutting width, the mobile device performs a circumferential movement around the boundary.
  • the processing width of the boundary area processing work is larger than the cutting width, so the movement path of the self-mobile device is set to a spiral shape, so from the path, the self-mobile device seems to go around the boundary N circles, but the N The circles are not concentric circles, but continuous spirals.
  • the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area
  • the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
  • the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
  • S606 Control the mobile device to re-acquire the reference positioning signal for positioning the position of the positioning calibration point.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S607 Control the self-positioning calibration point position of the self-moving device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
  • the last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
  • S608 Acquire the cumulative error measurement value in the moving process after the mobile device starts again, and determine whether the cumulative error measurement value reaches the set cumulative error threshold, and if so, control the mobile device to stop the boundary area processing work and execute 601, otherwise, Control the self-mobile device to continue to move along the boundary.
  • the mobile device Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
  • the self-mobile device After finishing the work task in the boundary area, the self-mobile device can return to the charging station position or locate the calibration point position and wait for the next work. If the working area is divided into multiple working sub-areas, the self-mobile device can continue Go to other sub-areas to be worked for regular work.
  • the preset task is: completing the preset boundary processing path from the mobile device.
  • the boundary area processing path can be a circumferential movement path around the boundary set based on the mapping boundary 901 and the maximum inner boundary 903. In order to achieve a better boundary processing effect, it is based on the mapping boundary 901 and the maximum inner boundary 903.
  • the relationship between the distance and the cutting width can be set with multiple circumferential moving paths.
  • the multiple circumferential moving paths may have overlapping areas.
  • the optimal solution is to have different moving paths as much as possible. This setting can ensure that the boundary The treatment effect of the area.
  • N N ⁇ 1
  • N 4.
  • N 5.
  • the direction may be different.
  • the direction of the boundary starting point during the first boundary processing is different from the second The direction of the starting point of the boundary is different during boundary processing.
  • the boundary processing of the N circumferential movement paths each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing
  • the position of the boundary starting point is different from that of the second boundary processing. If it is assumed that the first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction
  • the position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different.
  • step S701 after the step of stopping the processing of the boundary area from the mobile device, it further includes step S701 to step S709.
  • S701 Determine whether the self-mobile device has an area to work, if yes, execute S702, otherwise, execute S704.
  • the self-mobile device can return to the nearest work area for work.
  • S702 Control the mobile device to return to the waiting area for work.
  • S703 Determine whether the self-mobile device meets the preset condition of returning to the position of the positioning calibration point, if yes, execute S704, otherwise, control the self-mobile device to continue working.
  • the preset condition for returning to the position of the positioning calibration point is that the mobile device has completed the work in the working area or the power of the mobile device is insufficient or the error evaluation result indicates that the positioning error is large. It is necessary to reposition the calibration point position to obtain a new positioning reference Positioning signal.
  • S704 Control the self-mobile device to return to the positioning calibration point.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S705 Determine whether the self-mobile device has completed the boundary processing of the N circumferential movement paths, if yes, execute S709, otherwise, execute S706.
  • S706 Control the mobile device to re-acquire the reference positioning signal for positioning the position of the positioning calibration point.
  • the self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
  • S707 Control the self-positioning calibration point position of the self-moving device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
  • the last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
  • S708 Acquire the cumulative error measurement value in the moving process after the mobile device starts again, and determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute 701, otherwise, Control the self-mobile device to continue to move along the boundary.
  • the mobile device Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
  • the self-mobile device After finishing the work task in the boundary area, the self-mobile device can return to the position of the positioning calibration point and wait for the next work. If the work area is divided into multiple working sub-areas, the self-mobile device can continue to other waiting work The sub-area performs routine work.
  • a certain direction is used as the starting point.
  • the mobile device should be located at different positions on the boundary in the same direction as much as possible, that is, The mobile device is located at different positions of the boundary in the same direction in the boundary processing of different circumferential movement paths. This configuration can ensure that the boundary position in the same direction can be processed to the maximum extent, thereby improving the processing effect of the entire boundary.
  • the starting point direction on the boundary of the boundary processing of each circumferential movement path can also be different, that is, N boundary processing can have N boundary starting movement directions and N Regardless of the selection of the starting working position of the boundary, there is a processing overlap area between the N boundary processings.
  • Fig. 15 is a schematic structural diagram of a self-moving device according to an embodiment of the present invention. As shown in Figure 15, the self-mobile device also includes:
  • the boundary information acquisition module 21 controls the mobile device to move from the position of the calibration point to the boundary acquired by the boundary information acquisition module and move along the acquired boundary.
  • the signal acquisition module 22 is configured to acquire the current positioning signal from the mobile device during the movement, and the reference positioning signal from the mobile device before the current positioning signal is used to determine the current position information.
  • the mobile information acquisition module 23 further includes a cumulative error measurement value acquisition module and a positioning quality value acquisition module.
  • the cumulative error measurement value acquisition module is used to obtain the cumulative error measurement value.
  • the control module controls the mobile device to stop the boundary area processing when the cumulative error measurement value reaches the set cumulative error threshold.
  • the positioning quality value acquisition module is used to acquire the positioning quality value, and the control module controls the mobile device to stop the boundary area processing work when the positioning quality value reaches the set positioning quality threshold.
  • the reference positioning signal is directly collected from the mobile device from the satellite.
  • the cumulative error measurement value acquisition module may be used to acquire time data from the movement of the mobile device, the cumulative error threshold is a time threshold, and the control module determines whether the time value acquired by the movement information acquisition module reaches a set value. If the time value reaches the set time threshold value, control the mobile device to stop the processing of the boundary area.
  • the cumulative error measurement value acquisition module is used to acquire distance data from the movement of the mobile device
  • the cumulative error threshold is a distance threshold
  • the control module determines whether the distance value acquired by the movement information acquisition module reaches a set value. The distance threshold, if the distance value reaches the set distance threshold, the mobile device is controlled to stop the processing of the boundary area.
  • the self-mobile device further includes a boundary processing judgment module, a work area judgment module, and a regression judgment module.
  • the boundary processing judgment module is used to judge whether the self-mobile device has completed the boundary processing of N circumferential movement paths, N ⁇ 1, and when the boundary processing of the N circumferential movement paths has not been completed, the control module controls the self-moving The device leaves the boundary and returns to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning.
  • N>2 after the mobile device completes the task of processing the boundary area of a circumferential movement path, it continues to perform the boundary processing of N circumferential movement paths in the same step, N ⁇ 1, combined with different cutting widths of the cutter head
  • the boundary processing of the N circumferential movement paths there is a processing overlap area between the boundary processing of the N circumferential movement paths.
  • the direction may be different.
  • the direction of the boundary starting point during the first boundary processing is different from the second
  • the direction of the starting point of the boundary is different during boundary processing.
  • the boundary processing of the N circumferential movement paths each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing The position of the boundary starting point is different from that of the second boundary processing.
  • first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction The position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different
  • the number of circumferential movement paths can be preset from the mobile device, and when it is learned from the mobile device that the preset circumferential movement path number threshold has been reached, the boundary area processing task is ended.
  • the working area judgment module is used to judge whether the self-mobile device has a working area, and when there is a working area, the control module controls the self-mobile device to leave the boundary and return to the working area to work.
  • the regression judgment module is used to judge whether the self-mobile device meets the preset condition of returning to the position of the positioning calibration point, and when the preset condition of returning to the position of the positioning calibration point is satisfied, the control module controls the self-mobile device to return to the position from the working area Calibration point location.
  • the self-mobile device After the step of controlling the self-mobile device to stop the boundary area processing work, the self-mobile device has at least two behavior logics under the control of the control module, and the two behavior logics are based on the boundary processing judgment module to determine that the self-mobile device has not completed
  • the two behavior logics are specifically as follows.
  • the first behavior logic after the step of controlling the self-mobile device to stop the processing of the boundary area, the boundary processing judgment module judges that the self-mobile device has not completed the complete boundary processing of the N circumferential movement paths, and the control module controls the self-movement The device returns to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning. Then, the control module controls the self-positioning calibration point position of the mobile device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
  • the control module determines whether the cumulative error measurement value obtained after the mobile information acquisition module starts again reaches the set cumulative error threshold, and if the cumulative error measurement reaches the set cumulative error threshold, it controls the mobile device to stop the boundary area processing work again , And carry out the process cycle.
  • the second kind of behavior logic after the step of controlling the self-mobile device to stop the boundary area processing work, the working area judgment module judges that the self-mobile device has an area to be worked, and the control module controls the self-mobile device to return to the working area for work, The control module determines whether the mobile device meets the preset condition for returning to the position of the positioning calibration point.
  • the control module controls the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning, and boundary processing
  • the judging module judges that the mobile device has not completed the complete boundary processing of the N circumferential movement paths, and the control module controls the self-positioning calibration point position of the self-mobile device to start again in the boundary direction and move to the last termination point position and continue along Border movement, the control module judges whether the cumulative error measurement value obtained after the movement information acquisition module starts again reaches the set cumulative error threshold, and if the cumulative error measurement value reaches the set cumulative error threshold, control the mobile device to stop the boundary Area processing work, and the process cycle.
  • the self-mobile device in addition to the signal acquisition module 22, also includes:
  • the solution processing module 24 is configured to perform solution processing on the reference positioning signal and the current positioning signal to obtain error data, and the reference positioning signal subjected to the solution processing and the current positioning signal have a common satellite signal.
  • the position determining module 25 is configured to determine the current position information of the mobile device according to the error data and the position information of the reference positioning signal.
  • the self-mobile device further includes: a positioning calibration point position determination module for determining the reference coordinates of the positioning calibration point position, the signal acquisition module 22 acquires the positioning signal from the mobile device at the positioning calibration point position, and uses the positioning signal as The first reference positioning signal.
  • the position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device.
  • the self-mobile device includes: a solution condition determination module, the solution condition determination module is used to determine whether the selected reference positioning signal satisfies the solution condition; if the selected reference positioning signal meets the solution condition, the reference The positioning signal is used as the reference positioning signal for the subsequent calculation processing; if the selected reference positioning signal does not meet the calculation conditions, the satellite signal at the nearest time is selected as the reference positioning signal and repeatedly judge whether the selected reference positioning signal meets the calculation conditions , Repeat this step until the reference positioning signal that meets the calculation conditions is obtained.
  • a solution condition determination module is used to determine whether the selected reference positioning signal satisfies the solution condition
  • the reference The positioning signal is used as the reference positioning signal for the subsequent calculation processing
  • the satellite signal at the nearest time is selected as the reference positioning signal and repeatedly judge whether the selected reference positioning signal meets the calculation conditions , Repeat this step until the reference positioning signal that meets the calculation conditions is obtained.
  • the solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and further, the solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signal reaches Set the signal-to-noise ratio threshold.
  • the reference positioning signal and the current positioning signal that are subjected to the solution processing have a common satellite signal.
  • the number of shared satellites reaches the set threshold for the number of resolved satellites, the reference positioning signal and the current positioning signal are resolved.
  • the self-mobile device further includes an error evaluation module configured to: perform error evaluation on the current position information of the self-mobile device obtained by processing; and when the error evaluation result meets the error condition, return to the positioning calibration from the mobile device Click to reacquire the initial reference positioning signal.
  • the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area.
  • the error condition is: the working time of the mobile device reaches the set total working time threshold.
  • the error condition may also be: the selected reference positioning signal does not satisfy the solution condition.
  • the solution condition is: the number of shared satellites reaches the set threshold of the number of resolved satellites, and further, the solution condition is: the number of shared satellites reaches the set threshold of the number of resolved satellites, and the signal of the satellite signal The quality reaches the set signal-to-noise ratio threshold.
  • a plurality of positioning calibration points are arranged in the working area of the self-mobile device, and the plurality of positioning calibration points have known fixed reference coordinates among each other.
  • the self-moving The device uses the position information of the positioning calibration point as the current position information.
  • the self-moving device further includes:
  • a signal strength determination module for determining whether the signal strength of the satellite signal is less than a predetermined threshold
  • the position determining module is configured to determine the position information of the self-mobile device in combination with a positioning sensor in response to the signal strength of the satellite signal being less than a predetermined threshold.
  • the positioning sensor includes an inertial navigation device, or a lidar, or a carrierless communication device.
  • a computer-readable storage medium has computer program instructions stored thereon, and when the computer program instructions are executed by a processor, the processor executes the steps in the method for controlling a mobile device described above in this specification.
  • the computer-readable storage medium may adopt any combination of one or more readable media.
  • the readable medium may be a readable signal medium or a readable storage medium.
  • the readable storage medium may include, but is not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or a combination of any of the above, for example. More specific examples (non-exhaustive list) of readable storage media include: electrical connections with one or more wires, portable disks, hard disks, random access memory (RAM), read-only memory (ROM), erasable Type programmable read only memory (EPROM or flash memory), optical fiber, portable compact disk read only memory (CD-ROM), optical storage device, magnetic storage device, or any suitable combination of the above.
  • the present invention also provides a computer program product.
  • a method for controlling a mobile device is executed, the method comprising:
  • the current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information;
  • the cumulative error measurement value obtained from the mobile device in the moving process when the cumulative error measurement value reaches the set cumulative error threshold, the mobile device is controlled to stop the boundary area processing work.
  • a computer program product includes computer program instructions that, when run by a processor, cause the processor to execute the steps in the "method for controlling a self-mobile device" mentioned in this specification.
  • the computer program product may use any combination of one or more programming languages to write program codes for performing the operations of the embodiments of the present application.
  • the programming languages include object-oriented programming languages, such as Java, C++, etc. , Also includes conventional procedural programming languages, such as "C" language or similar programming languages.
  • the program code can be executed entirely on the user's computing device, partly on the user's device, executed as an independent software package, partly on the user's computing device and partly executed on the remote computing device, or entirely on the remote computing device or server Executed on.
  • an electronic device which includes:
  • Memory for storing computer executable instructions
  • the processor is configured to execute computer-executable instructions stored in the memory to execute a method for controlling a mobile device, the method comprising:
  • the current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information;
  • the cumulative error measurement value obtained from the mobile device in the moving process when the cumulative error measurement value reaches the set cumulative error threshold, the mobile device is controlled to stop the boundary area processing work.
  • the electronic device may be an electronic device integrated in a mobile station of a self-mobile device, or a stand-alone device independent of the mobile station, and the stand-alone device can communicate with the mobile station to realize the self-mobile device according to an embodiment of the present invention ⁇ Control methods.
  • FIG. 17 is a schematic block diagram of an electronic device according to an embodiment of the present invention.
  • the electronic device 600 includes one or more processors 610 and a memory 620.
  • the processor 610 may be a central processing unit (CPU) or other form of processing unit with data processing capability and/or instruction execution capability, and may control other components in the electronic device 600 to perform desired functions.
  • CPU central processing unit
  • the processor 610 may be a central processing unit (CPU) or other form of processing unit with data processing capability and/or instruction execution capability, and may control other components in the electronic device 600 to perform desired functions.
  • the memory 620 may include one or more computer program products, and the computer program products may include various forms of computer-readable storage media, such as volatile memory and/or non-volatile memory.
  • the volatile memory may include random access memory (RAM) and/or cache memory (cache), for example.
  • the non-volatile memory may include, for example, read-only memory (ROM), hard disk, flash memory, and the like.
  • One or more computer program instructions may be stored on the computer-readable storage medium, and the processor 610 may run the program instructions to implement the positioning fault alarm of the mobile device according to the various embodiments of the present invention described above. Methods and/or other desired functions.
  • the computer-readable storage medium may also store various contents such as the position data of the antenna, the installation position of the antenna relative to the mobile device, and the like.
  • the electronic device 600 may further include: an input device 630 and an output device 640, and these components are interconnected by a bus system and/or other forms of connection mechanisms (not shown).
  • the input device 630 may be used to receive user input.
  • the output device 640 can directly output various information to the outside, or control the mobile station to send signals.
  • the electronic device 600 may also include any other appropriate components according to specific application conditions.
  • each part of the present invention can be implemented by hardware, software, firmware or a combination thereof.
  • multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system.
  • a suitable instruction execution system For example, if it is implemented by hardware, as in another embodiment, it can be implemented by any one or a combination of the following technologies known in the art: Discrete logic circuits, application-specific integrated circuits with suitable combinational logic gates, programmable gate arrays (PGA), field programmable gate arrays (FPGA), etc.
  • the functional units in the various embodiments of the present invention may be integrated into one processing module, or each unit may exist alone physically, or two or more units may be integrated into one module.
  • the above-mentioned integrated modules can be implemented in the form of hardware or software function modules. If the integrated module is implemented in the form of a software function module and sold or used as an independent product, it can also be stored in a computer readable storage medium.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A self-moving device and a control method therefor. The method comprises: obtaining boundary information of a boundary information domain on a working region map (S101); controlling a self-moving device having accumulated positioning error to move on the boundary after completion of position calibration at a positioning calibration point, and perform boundary region processing work (S102); and obtaining an accumulated error measurement value or a positioning quality value of the self-moving device after the self-moving device leaves the positioning calibration point, and when the accumulated error measurement value reaches a set accumulated error threshold or the positioning quality value reaches a set positioning quality threshold, controlling the self-moving device to stop the boundary region processing work (S103). For a positioning mode having accumulated error, the self-moving device and the control method therefor can make full use of a time period having the highest positioning accuracy after the self-moving device starts to process a boundary region first, thereby improving the boundary region processing efficiency and effect.

Description

自移动设备及其控制方法、自动工作系统Self-moving equipment and its control method and automatic working system
本申请要求了申请日为2019年09月29日,申请号为201910930499.9的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims the priority of the Chinese patent application whose application date is September 29, 2019 and the application number is 201910930499.9, the entire content of which is incorporated into this application by reference.
技术领域Technical field
本发明涉及自移动设备,尤其的,涉及一种自移动设备的控制方法、采用该控制方法的自移动设备、自动工作系统、计算机可读存储介质、计算机程序产品、电子设备。The present invention relates to a self-mobile device, and in particular, to a control method of a self-mobile device, a self-mobile device adopting the control method, an automatic working system, a computer-readable storage medium, a computer program product, and an electronic device.
背景技术Background technique
随着计算机技术和人工智能技术的不断进步,类似于智能机器人的自动行走设备已经开始慢慢的走进人们的生活。三星、伊莱克斯等公司均开发了全自动吸尘器并已经投入市场。这种全自动吸尘器通常体积小巧,集成有环境传感器、自驱系统、吸尘系统、电池和充电系统,能够无需人工操控,自行在室内巡航,在能量低时自动返回充电站,对接并充电,然后继续巡航吸尘。同时,哈斯科瓦纳等公司开发了类似的智能割草机,其能够自动在用户的草坪中割草、充电,无需用户干涉。由于这种自动割草系统一次设置之后就无需再投入精力管理,将用户从清洁、草坪维护等枯燥且费时费力的家务工作中解放出来,因此受到极大欢迎。With the continuous advancement of computer technology and artificial intelligence technology, autonomous walking equipment similar to intelligent robots has begun to slowly enter people's lives. Samsung, Electrolux and other companies have developed fully automatic vacuum cleaners and have already put them on the market. This kind of fully automatic vacuum cleaner is usually small in size, integrated with environmental sensors, self-driving system, dust collection system, battery and charging system. It can cruise indoors without manual control, and automatically return to the charging station when the energy is low, docking and charging. Then continue to cruise and vacuum. At the same time, companies such as Haskovana have developed similar smart lawn mowers, which can automatically mow and charge the user's lawn without user intervention. Since this automatic mowing system does not need to invest in management after it is set up once, it frees users from boring and time-consuming housework such as cleaning and lawn maintenance, so it is very popular.
现有的自动割草机一般应用于面积较大的工作区域,如1000平方米。在常规的自动割草机定位中,都需要采用基站和接收站两套系统,基站的目的是实时提供接收站一些卫星的观测值,接收站通过自己的观测值,采用RTK技术计算定位数据,通过数据的差分修正来实现高精度定位,获得自动割草机的位置坐标,这种技术可以实现稳定、长期的高精度绝对定位。基站可以是自建基站,也可以是共享基站。但是,不管采用哪种基站,对于家庭用户来说,基站需要购买、安装,成本高,难度大。Existing automatic lawn mowers are generally used in large working areas, such as 1,000 square meters. In conventional automatic lawn mower positioning, two systems of base station and receiving station are required. The purpose of the base station is to provide real-time observations of some satellites of the receiving station. The receiving station uses its own observation values to calculate positioning data using RTK technology. High-precision positioning is achieved through data differential correction, and the position coordinates of the automatic lawn mower are obtained. This technology can achieve stable, long-term high-precision absolute positioning. The base station can be a self-built base station or a shared base station. However, no matter what kind of base station is used, for home users, the base station needs to be purchased and installed, which is costly and difficult.
如果抛弃实体基站而使用虚拟基站,会存在累计误差,考虑到自动割草机定位过程中的累积误差,防止自动割草机移动出边界,一般自动割草机移动的边界比实际建图的边界会向内缩减一段距离,这样加上自动割草机本身的累积定位误差,使得边界处的割草效果并不理想。If you abandon the physical base station and use the virtual base station, there will be accumulated errors. Considering the accumulated error in the positioning process of the automatic lawn mower, prevent the automatic lawn mower from moving out of the boundary. Generally, the moving boundary of the automatic lawn mower is higher than the actual boundary It will reduce a certain distance inward, so the cumulative positioning error of the automatic lawn mower itself makes the mowing effect at the boundary unsatisfactory.
因此有必要对使用虚拟基站的自动割草机的边界割草方式进行改进,以提升边界处的割草效率及割草效果。Therefore, it is necessary to improve the border mowing method of the automatic lawn mower using the virtual base station to improve the mowing efficiency and the mowing effect at the border.
发明内容Summary of the invention
针对现有技术存在的不足,本发明提供一种在使用虚拟基站进行定位的情况下实现自移动设备控制的方法及采用该控制方法的自移动设备,解决使用虚拟基站带来的累计误差导致的边界处理效果不理想的问题。In view of the shortcomings in the prior art, the present invention provides a method for realizing self-mobile equipment control under the condition of using virtual base stations for positioning and self-mobile equipment using the control method to solve the cumulative error caused by the use of virtual base stations. The problem of unsatisfactory boundary processing effect.
本发明提出一种自移动设备的控制方法,包括步骤:The present invention provides a control method for self-mobile equipment, which includes the steps:
S101:获取工作区域地图上的边界信息;S101: Obtain boundary information on the work area map;
S102:控制具有累积定位误差的自移动设备在一定位校准点完成位置校准后在边界上移动,并进行边界区域处理工作;S102: Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
S103:获取自移动设备离开定位校准点后的累积误差衡量值或定位质量值,当累积误差衡量值达到设定的累积误差阈值时或定位质量值达到设定的定位质量阈值时,控制 自移动设备停止边界区域处理工作,其中,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值,其中,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置;S103: Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point, and control the self-movement when the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold The device stops processing the boundary area, wherein the cumulative error measurement value is the value of the time since the mobile device left the positioning calibration point, or the value of the movement distance since the mobile device left the positioning calibration point, wherein the position of the positioning calibration point It is the position of the charging station or the position with fixed coordinates set in the working area;
在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤:After the step of controlling the mobile device to stop the processing of the boundary area, the method further includes the following steps:
判断自移动设备是否完成预设的边界处理路径,若是,则结束边界区域处理工作,否则,重复步骤S102至S103,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离,或,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和;Determine whether the mobile device has completed the preset boundary processing path. If yes, end the boundary area processing work; otherwise, repeat steps S102 to S103. The length of the preset boundary processing path is proportional to the processing width of the boundary area processing work. , The boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing work is the distance between the mapping boundary and the maximum inner boundary, or the boundary information includes distinguishing the working area and the maximum inner boundary. The boundary line of the non-working area, the processing width range of the boundary area processing work is 70cm-90cm from the boundary line to the working area, and the processing width of the boundary area processing work is the set safety distance and setting The sum of cumulative error thresholds;
在重复步骤S102至S103之前,还包括:Before repeating steps S102 to S103, it also includes:
S301:判断自移动设备是否存在待工作区域,若是,则执行S302至S304,否则,重复步骤S102至S103;S301: Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
S302:控制自移动设备返回待工作区域进行工作;S302: Control the mobile device to return to the waiting area for work;
S303:判断自移动设备是否满足返回一定位校准点位置的预设条件,若是,则执行S304,否则,控制自移动设备继续工作;S303: Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
S304:控制自移动设备返回一定位校准点。S304: Control the mobile device to return to a positioning calibration point.
本发明提出一种自移动设备的控制方法,其包括步骤:The present invention provides a control method for self-mobile equipment, which includes the steps:
S101:获取工作区域地图上的边界信息;S101: Obtain boundary information on the work area map;
S102:控制具有累积定位误差的自移动设备在一定位校准点完成位置校准后在边界上移动,并进行边界区域处理工作;S102: Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
S103:获取自移动设备离开定位校准点后的累积误差衡量值或定位质量值,当累积误差衡量值达到设定的累积误差阈值时或定位质量值达到设定的定位质量阈值时,控制自移动设备停止边界区域处理工作。S103: Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point, and control the self-movement when the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold The equipment stops processing the boundary area.
进一步的,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值。Further, the cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point.
进一步的,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。Further, the position of the positioning calibration point is a charging station position or a position with fixed coordinates set in a working area.
进一步的,在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤:Further, after the step of controlling the mobile device to stop the processing of the boundary area, the method further includes the following steps:
判断自移动设备是否完成预设任务,若是,则结束边界区域处理工作,否则,重复步骤S102至S103。It is determined whether the mobile device has completed the preset task, if so, the boundary area processing work is ended; otherwise, steps S102 to S103 are repeated.
进一步的,所述预设任务为:自移动设备完成预设的边界处理路径。Further, the preset task is: completing the preset boundary processing path from the mobile device.
进一步的,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比。Further, the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
进一步的,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离。Further, the boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing task is the distance between the mapping boundary and the maximum inner boundary.
进一步的,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。Further, the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
进一步的,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和。Further, the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
进一步的,在重复步骤S102至S103之前,还包括:Further, before repeating steps S102 to S103, the method further includes:
S301:判断自移动设备是否存在待工作区域,若是,则执行S302至S304,否则,重复步骤S102至S103;S301: Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
S302:控制自移动设备返回待工作区域进行工作;S302: Control the mobile device to return to the waiting area for work;
S303:判断自移动设备是否满足返回一定位校准点位置的预设条件,若是,则执行S304,否则,控制自移动设备继续工作;S303: Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
S304:控制自移动设备返回一定位校准点。S304: Control the mobile device to return to a positioning calibration point.
本发明还提出一种自移动设备,其包括:The present invention also provides a self-moving device, which includes:
壳体;case;
移动模块,用于带动所述壳体移动;The moving module is used to drive the housing to move;
任务执行模块,用于执行工作任务;Task execution module, used to perform work tasks;
控制模块,所述控制模块与移动模块、任务执行模块电连接,控制移动模块带动自移动设备移动,并控制任务执行模块执行工作任务;A control module, which is electrically connected to the mobile module and the task execution module, controls the mobile module to drive the mobile device to move, and controls the task execution module to perform work tasks;
所述自移动设备还包括:The self-moving device further includes:
边界信息获取模块,用于获取边界信息,所述控制模块控制自移动设备在一定位校准点完成校准后离开定位校准点后在边界上移动,并进行边界区域处理工作;A boundary information acquisition module for acquiring boundary information, the control module controls the mobile device to move on the boundary after leaving the positioning calibration point after completing calibration at a positioning calibration point, and processing the boundary area;
累积误差衡量值获取模块,用于获取累积误差衡量值,所述控制模块控制自移动设备在累积误差衡量值达到设定的累积误差阈值时停止边界区域处理工作;A cumulative error measurement value acquisition module, configured to obtain a cumulative error measurement value, and the control module controls the mobile device to stop the boundary area processing work when the cumulative error measurement value reaches a set cumulative error threshold;
定位质量值获取模块,用于获取定位质量值,所述控制模块控制自移动设备在定位质量值达到设定的定位质量阈值时停止边界区域处理工作。The positioning quality value acquisition module is used to acquire the positioning quality value, and the control module controls the mobile device to stop the boundary area processing work when the positioning quality value reaches the set positioning quality threshold.
进一步的,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值。Further, the cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point.
进一步的,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。Further, the position of the positioning calibration point is a charging station position or a position with fixed coordinates set in a working area.
进一步的,所述自移动设备包括:Further, the self-moving device includes:
边界处理判断模块,用于判断自移动设备是否完成预设任务。The boundary processing judgment module is used to judge whether the self-mobile device has completed the preset task.
进一步的,所述预设任务为:自移动设备完成预设的边界处理路径。Further, the preset task is: completing the preset boundary processing path from the mobile device.
进一步的,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比。Further, the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
进一步的,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离。Further, the boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing task is the distance between the mapping boundary and the maximum inner boundary.
进一步的,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。Further, the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area.
进一步的,所述边界区域处理工作的处理宽度为设定的安全距离与设定的自移动设备的累积误差阈值之和。Further, the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold of the mobile device.
进一步的,所述自移动设备包括:Further, the self-moving device includes:
工作区域判断模块,用于判断自移动设备是否存在待工作区域,并在存在待工作区域时,所述控制模块控制自移动设备停止边界区域处理工作后返回待工作区域进行工作;The working area judging module is used to judge whether the self-mobile device has a working area, and when there is a working area, the control module controls the self-mobile device to stop the boundary area processing work and then return to the working area to work;
回归判断模块,用于判断自移动设备是否满足返回一定位校准点的预设条件,并在满足返回一定位校准点的预设条件时,所述控制模块控制自移动设备从工作区域返回一定位校准点。The regression judgment module is used to judge whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point, and when the preset condition of returning to a positioning calibration point is satisfied, the control module controls the self-mobile device to return to a positioning from the working area Calibration point.
本发明还提出一种自动工作系统,其包括:The present invention also provides an automatic working system, which includes:
如上述的自移动设备,在限定的工作区域内移动和工作。As the above-mentioned self-moving device, it moves and works within a limited work area.
本发明还提出一种计算机可读存储介质,其上存储有计算机程序,当所述计算机程序指令被计算装置执行时,可操作来执行如上述的自移动设备的控制方法。The present invention also provides a computer-readable storage medium on which a computer program is stored, and when the computer program instructions are executed by a computing device, the computer program instructions are operable to execute the above-mentioned control method of a mobile device.
本发明还提出一种计算机程序产品,当所述计算机程序产品中的指令由处理器执行时,执行如上述的自移动设备的控制方法。The present invention also provides a computer program product. When the instructions in the computer program product are executed by a processor, the above-mentioned self-mobile device control method is executed.
本发明还提出一种电子设备,包括:The present invention also provides an electronic device, including:
存储器,用于存储计算机可执行指令;和Memory for storing computer executable instructions; and
处理器,用于执行所述存储器存储的计算机可执行指令,以执行如上述的自移动设备的控制方法。The processor is configured to execute computer-executable instructions stored in the memory to execute the control method of the self-mobile device as described above.
与现有技术相比,本发明可以充分利用自移动设备出发后的定位精度最高的时段先对边界进行处理,提升了边界处理的效率及边界处理的效果,解决累计误差导致的边界处理不理想问题。Compared with the prior art, the present invention can make full use of the time period when the positioning accuracy is highest since the mobile device starts to process the boundary first, improve the efficiency of boundary processing and the effect of boundary processing, and solve the problem of unsatisfactory boundary processing caused by accumulated errors. problem.
附图说明Description of the drawings
以上所述的本发明解决的技术问题、技术方案以及有益效果可以通过下面的能够实现本发明的较佳的具体实施例的详细描述,同时结合附图描述而清楚地获得。The technical problems, technical solutions, and beneficial effects solved by the present invention described above can be clearly obtained through the following detailed description of the preferred specific embodiments that can implement the present invention, together with the description of the accompanying drawings.
附图以及说明书中的相同的标号和符号用于代表相同的或者等同的元件。The same reference numerals and symbols in the drawings and the specification are used to represent the same or equivalent elements.
图1为本发明实施例中自动工作系统的示意图。Fig. 1 is a schematic diagram of an automatic working system in an embodiment of the present invention.
图2为本发明实施例中自移动设备为智能割草机时在工作区域内工作的示意图。Fig. 2 is a schematic diagram of working in a working area when the self-mobile device is a smart lawn mower in an embodiment of the present invention.
图3为本发明实施例中自动工作系统包括两个子工作区域的示意图。Fig. 3 is a schematic diagram of an automatic working system including two sub-working areas in an embodiment of the present invention.
图4为存在累计定位误差的自移动设备的边界处理的模拟示意图。Fig. 4 is a schematic diagram of a simulation of boundary processing of a self-mobile device with accumulated positioning errors.
图5为本发明的自移动设备的控制方法的流程示意图。Fig. 5 is a schematic flowchart of the control method of a mobile device according to the present invention.
图6为本发明的自移动设备的定位方法的流程示意图。Fig. 6 is a schematic flow chart of a positioning method from a mobile device according to the present invention.
图7为本发明的自移动设备中参考定位信号包括多个时,获取参考定位信号的方法的流程示意图。FIG. 7 is a schematic flowchart of a method for obtaining a reference positioning signal when the mobile device includes multiple reference positioning signals according to the present invention.
图8为本发明的自移动设备的控制方法中第一种行为逻辑的移动路径示意图。FIG. 8 is a schematic diagram of the movement path of the first behavior logic in the control method of the self-mobile device of the present invention.
图9为本发明的自移动设备的控制方法中第二种行为逻辑的移动路径示意图。FIG. 9 is a schematic diagram of the movement path of the second behavior logic in the control method of the self-mobile device of the present invention.
图10为本发明的自移动设备的控制方法中第一种行为逻辑中单次完整的边界处理的流程示意图。FIG. 10 is a schematic flow diagram of a single complete boundary processing in the first behavior logic in the control method of the self-mobile device of the present invention.
图11为本发明的自移动设备的控制方法中第一种行为逻辑中N个周向移动路径的完整的边界处理的流程示意图。FIG. 11 is a schematic flowchart of the complete boundary processing of N circumferential movement paths in the first behavior logic in the control method of the self-mobile device of the present invention.
图12为本发明的自移动设备的控制方法中N个周向移动路径的完整的边界处理的移动路径示意图。FIG. 12 is a schematic diagram of a complete boundary processing movement path of N circumferential movement paths in the method for controlling a self-moving device of the present invention.
图13为本发明的自移动设备的控制方法中第二种行为逻辑中单次完整的边界处理的流程示意图。FIG. 13 is a schematic flowchart of a single complete boundary processing in the second type of behavior logic in the control method of the self-mobile device of the present invention.
图14为本发明的自移动设备的控制方法中第二种行为逻辑中N个周向移动路径的完整的边界处理的流程示意图。FIG. 14 is a schematic flowchart of the complete boundary processing of N circumferential movement paths in the second behavior logic in the control method of the self-mobile device of the present invention.
图15为本发明自移动设备的结构示意图。Fig. 15 is a schematic diagram of the structure of a mobile device of the present invention.
图16为本发明自移动设备中用于定位结构的结构示意图。Fig. 16 is a schematic structural diagram of a positioning structure used in a mobile device of the present invention.
图17为本发明一实施例的电子设备的示意性框图。FIG. 17 is a schematic block diagram of an electronic device according to an embodiment of the present invention.
其中,among them,
100、自动工作系统          1、自动割草机                 2、充电站100. Automatic working system 1. Automatic lawn mower 2. Charging station
3、壳体                    4、房屋                       5、移动模块3. Housing 4. Housing 5. Mobile module
6、草坪                    7、任务执行模块               8、边界6. Lawn 7. Task execution module 8. Boundary
9、移动站                  9.1、建图边界                 902、缓冲边界9. Mobile station 9.1. Map boundary 902, Buffer boundary
903、最大内边界            904、实际轨迹                 21、边界信息获取模块903. Largest inner boundary 904. Actual trajectory 21. Boundary information acquisition module
22、信号获取模块           23、移动信息获取模块          24、解算处理模块22. Signal acquisition module 23. Mobile information acquisition module 24. Solution processing module
25、位置确定模块           600、电子设备                 610、处理器25. Location determination module 600, electronic equipment 610, processor
620、存储器                630、输入装置                 640、输出装置620, memory 630, input device 640, output device
具体实施方式detailed description
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。相反,本发明的实施例包括落入所附加权利要求书的精神和内涵范围内的所有变化、修改和等同物。The embodiments of the present invention are described in detail below. Examples of the embodiments are shown in the accompanying drawings, in which the same or similar reference numerals indicate the same or similar elements or elements with the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary, and are only used to explain the present invention, but should not be understood as limiting the present invention. On the contrary, the embodiments of the present invention include all changes, modifications and equivalents falling within the scope of the spirit and connotation of the appended claims.
在下面的实施例描述中,“误差数据”指的是根据两组具有共用卫星数的卫星信号进行分析后获得的误差电文,该误差电文用于后续对自移动设备的定位。“误差评估”指的是在自移动设备的移动过程中,对自移动设备位置信息的准确度进行评估,分析定位的准确性或者误差率,通过误差评估避免自移动设备一直沿着错误的方向继续移动。“边界”不仅仅指工作区域与非工作区域之间的边界,比如草坪内与草坪之间的边界,还指工作区域内障碍物周围形成的可工作区域与不可工作区域之间的边界,比如障碍物可以为草坪内的树木、孤岛等。“边界信息”指边界的位置等表征边界特征的对自移动设备有所帮助的信息。“边界区域处理工作”指对边界进行处理的活动,可以包括割草、清洁、浇灌、扫雪等。In the description of the following embodiments, "error data" refers to an error message obtained after analyzing two sets of satellite signals with a common number of satellites, and the error message is used for subsequent positioning of the mobile device. "Error evaluation" refers to the evaluation of the accuracy of the location information of the self-mobile device during the movement of the self-mobile device, analysis of the accuracy or error rate of the positioning, and error evaluation to avoid the self-mobile device from following the wrong direction. Keep moving. "Border" not only refers to the boundary between the work area and the non-work area, such as the boundary between the lawn and the lawn, but also refers to the boundary between the workable area and the non-workable area formed around obstacles in the work area, such as Obstacles can be trees, islands, etc. in the lawn. "Boundary information" refers to information that characterizes the boundary features, such as the location of the boundary, which is helpful to the mobile device. "Border area processing work" refers to the activities of processing the boundary, which can include mowing, cleaning, watering, snow removal, etc.
图1为本发明第一实施例的自动工作系统100的示意图。如图1所示,本发明实施例中自动工作系统100包括自移动设备。自移动设备可以在地图限定的工作区域内移动和工作。本实施例中,自移动设备为自动割草机1,在其他实施例中,自移动设备也可以为自动清洁设备、自动浇灌设备、自动扫雪机等适合无人值守的设备。Fig. 1 is a schematic diagram of an automatic working system 100 according to a first embodiment of the present invention. As shown in FIG. 1, the automatic working system 100 in the embodiment of the present invention includes a self-moving device. Self-mobile devices can move and work within the work area defined by the map. In this embodiment, the self-moving equipment is an automatic lawn mower 1. In other embodiments, the self-moving equipment may also be equipment suitable for unattended operation, such as automatic cleaning equipment, automatic watering equipment, and automatic snowplow.
如图2所示,自动割草机1包括壳体3,移动模块5,任务执行模块7,能源模块,控制模块等。自动割草机1的工作地点为草坪6。其中,移动模块5包括履带或轮组,由驱动马达驱动以带动自动割草机1移动。任务执行模块7包括切割组件,安装于壳体3的底部,由切割马达驱动以旋转执行割草工作。能源模块包括电池包(图未示),为自动割草机1的移动和工作提供电能。控制模块与移动模块5、任务执行模块7和能源模块电连接,控制移动模块带动自动割草机1移动,并控制任务执行模块执行工作任务。As shown in Fig. 2, the automatic lawn mower 1 includes a housing 3, a mobile module 5, a task execution module 7, an energy module, a control module, and the like. The working place of the automatic lawn mower 1 is the lawn 6. Among them, the moving module 5 includes a crawler belt or a wheel set, which is driven by a driving motor to drive the automatic lawn mower 1 to move. The task execution module 7 includes a cutting assembly, which is installed at the bottom of the housing 3 and is driven by a cutting motor to rotate and perform the mowing work. The energy module includes a battery pack (not shown) to provide electrical energy for the movement and operation of the automatic lawn mower 1. The control module is electrically connected to the mobile module 5, the task execution module 7 and the energy module, controls the mobile module to drive the automatic lawn mower 1 to move, and controls the task execution module to perform work tasks.
如图3所示,自动工作系统用于在预定的工作区域内工作,在一个实施例中,工作区域包括至少两个相互分离的子工作区域,即区域C和区域D。工作区域与非工作区域之间形成边界8,工作区域内可能会有障碍,比如树木、凹坑等。As shown in FIG. 3, the automatic working system is used to work in a predetermined working area. In one embodiment, the working area includes at least two mutually separated sub-working areas, namely, area C and area D. A boundary 8 is formed between the working area and the non-working area, and there may be obstacles in the working area, such as trees, pits, etc.
如图1所示,自动工作系统100还包括充电站2,用于为自动割草机1补给电能。充电站2可以设置在房屋4旁边的空旷地方。充电站2还可以设在工作区域内或者设在 工作区域的边界上。本实施例中,自动工作系统100包括导航模块,用于输出自动割草机的当前位置。具体的,导航模块包括移动站9。As shown in FIG. 1, the automatic working system 100 further includes a charging station 2 for supplying electric power to the automatic lawn mower 1. The charging station 2 can be set in an open place beside the house 4. The charging station 2 can also be located in the work area or on the boundary of the work area. In this embodiment, the automatic working system 100 includes a navigation module for outputting the current position of the automatic lawn mower. Specifically, the navigation module includes a mobile station 9.
移动站9与控制模块电连接,用来存储和处理自动割草机1获得的卫星信号,使得自动割草机1能够在工作区域内移动并工作。本实施例中,移动站9用以接收卫星信号,卫星信号包括卫星角度、时钟等。卫星信号可以为GPS信号,也可以为伽利略、北斗等信号,或同时使用几种信号。具体的,本实施例中,卫星信号为差分GPS(DGPS)信号。The mobile station 9 is electrically connected with the control module to store and process the satellite signals obtained by the automatic lawn mower 1, so that the automatic lawn mower 1 can move and work in the working area. In this embodiment, the mobile station 9 is used to receive satellite signals, and the satellite signals include satellite angles, clocks, and so on. The satellite signal can be a GPS signal, Galileo, Beidou, etc., or several signals can be used at the same time. Specifically, in this embodiment, the satellite signal is a differential GPS (DGPS) signal.
导航模块输出位置信息的同时,可以输出定位信号的精度等级。自动割草机1也可以根据导航模块输出的位置信息来判断当前定位状态,输出定位状态指示。判断导航模块输出的位置信息的质量的依据,可以是导航模块能够接收到信号的卫星个数,或者定位状态指示,或者精度因子,或者多种因素综合,设置重要度权重,来获得位置信息质量。导航模块输出的位置信息的质量可以由导航模块本身进行误差评估,控制模块获取评估结果,也可以由控制模块利用导航模块的输出进行误差评估,得到评估结果。While the navigation module outputs position information, it can also output the accuracy level of the positioning signal. The automatic lawn mower 1 can also determine the current positioning state according to the position information output by the navigation module, and output a positioning state indication. The basis for judging the quality of the location information output by the navigation module can be the number of satellites that the navigation module can receive signals, or the positioning status indicator, or the accuracy factor, or a combination of multiple factors, setting the importance weight to obtain the location information quality . The quality of the location information output by the navigation module can be evaluated by the navigation module itself for error, and the control module can obtain the evaluation result, or the control module can use the output of the navigation module for error evaluation to obtain the evaluation result.
本实施例中,自动割草机1还包括至少一个位置传感器,与控制模块电连接,检测与自动割草机1的位置相关的特征。位置传感器可以包括摄像头、雷达、电容传感器、惯性导航传感器等。本实施例中,位置传感器为惯性导航传感器,惯性导航传感器可以包括加速度计、里程计、罗盘、陀螺仪、姿态检测传感器等,检测自移动设备的速度、加速度、行驶方向等。本实施例中,当导航模块输出的位置信息的质量不满足预设条件时,控制模块至少部分的基于位置传感器的输出判断自动割草机1的当前位置。具体的,可以将导航模块输出的位置信息与位置传感器的输出进行融合处理,来得到自动割草机的当前位置。以惯性导航传感器为例,若持续利用惯性导航传感器进行导航,惯性导航传感器的输出的误差将随时间累积,导致输出的位置信息的精度降低。因此,当导航模块输出的位置信息的质量满足预设条件时,利用卫星导航装置的输出来校正位置传感器的输出,以使得位置传感器能够保持高精度的输出。In this embodiment, the automatic lawn mower 1 further includes at least one position sensor, which is electrically connected to the control module, and detects features related to the position of the automatic lawn mower 1. Position sensors can include cameras, radars, capacitive sensors, inertial navigation sensors, and so on. In this embodiment, the position sensor is an inertial navigation sensor. The inertial navigation sensor may include an accelerometer, an odometer, a compass, a gyroscope, a posture detection sensor, etc., to detect the speed, acceleration, and driving direction of the mobile device. In this embodiment, when the quality of the location information output by the navigation module does not meet the preset condition, the control module at least partly determines the current location of the automatic lawn mower 1 based on the output of the location sensor. Specifically, the position information output by the navigation module and the output of the position sensor can be fused to obtain the current position of the automatic lawn mower. Taking 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 navigation module meets the 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 a high-precision output.
所以,本实施例中,移动站9工作时,可以只利用GPS定位信号来导航,也可以利用GPS定位信号与惯性导航数据经融合处理后的定位信号来导航,或者,在GPS信号弱的时候,也可以只利用惯性导航数据来导航。移动站9还可以包括指示器(图未示),输出当前位置的差分GPS信号是否良好的指示。Therefore, in this embodiment, when the mobile station 9 is working, it can only use GPS positioning signals for navigation, or use GPS positioning signals and inertial navigation data fusion processing positioning signals for navigation, or when the GPS signal is weak , You can also use only inertial navigation data to navigate. The mobile station 9 may also include an indicator (not shown) to output an indication of whether the differential GPS signal of the current position is good.
本实施例中,移动站9与自动割草机1的壳体3可拆卸的连接。移动站9包括与自动割草机1的壳体连接的第一接口(图未示)。自动割草机1工作时移动站9安装于自动割草机1的壳体3。移动站9与自动割草机1的壳体3连接时,可实现与自动割草机1的控制模块的电连接,移动站9输出自动割草机1的当前位置坐标,控制模块根据自动割草机1的当前位置控制自动割草机1的移动和工作。或者,移动站根据当前位置坐标输出控制指令给控制模块。需要说明的是,本发明实施例中,移动站9包括独立的电源模块(图未示),移动站9与自动割草机1的壳体3分离时,可以独立工作。在其他实施例中,移动站9与自动割草机1的壳体3可以为不可拆卸的连接,如果是自移动设备工作过程中的定位,则移动站9与自动割草机1的壳体3是否可拆卸并不影响定位。In this embodiment, the mobile station 9 is detachably connected to the housing 3 of the automatic lawn mower 1. The mobile station 9 includes a first interface (not shown) connected to the housing of the automatic lawn mower 1. When the automatic lawn mower 1 is working, the mobile station 9 is installed on the housing 3 of the automatic lawn mower 1. When the mobile station 9 is connected to the housing 3 of the automatic lawn mower 1, it can realize the electrical connection with the control module of the automatic lawn mower 1. The mobile station 9 outputs the current position coordinates of the automatic lawn mower 1, and the control module according to the automatic cutting The current position of the lawn mower 1 controls the movement and work of the automatic lawn mower 1. Or, the mobile station outputs a control command to the control module according to the current position coordinates. It should be noted that, in the embodiment of the present invention, the mobile station 9 includes an independent power supply module (not shown in the figure). When the mobile station 9 is separated from the housing 3 of the automatic lawn mower 1, it can work independently. In other embodiments, the mobile station 9 and the housing 3 of the automatic lawn mower 1 may be non-detachable connection. If it is positioned during the operation of the mobile device, the mobile station 9 and the housing 3 of the automatic lawn mower 1 3 Whether it is detachable does not affect the positioning.
移动站9通过利用当前定位信号之前的参考定位信号获取误差数据并基于该误差数据及该参考定位信号的位置信息处理获得当前位置信息,并未利用自建基站或共享基站在当前时刻实时收到的卫星信号进行处理而获得当前位置信息,所以可以取消自建基站或共享基站,简化用户安装,大幅降低成本。The mobile station 9 obtains error data by using the reference positioning signal before the current positioning signal and obtains the current position information based on the error data and the position information processing of the reference positioning signal. It does not use a self-built base station or a shared base station to receive it in real time at the current moment. The satellite signal is processed to obtain current location information, so self-built base stations or shared base stations can be eliminated, which simplifies user installation and greatly reduces costs.
本实施例以该不设置自建基站或共享基站的自移动设备的定位方法被配置为自移动设备的定位装置中来举例说明。In this embodiment, the positioning method of a self-mobile device without a self-built base station or a shared base station is configured as a positioning apparatus of the self-mobile device for illustration.
本实施例中自移动设备的定位装置可以设置在服务器中,或者也可以设置在移动站中,本申请实施例对此不作限制。The positioning device of the mobile device in this embodiment may be set in the server, or may also be set in the mobile station, which is not limited in the embodiment of the present application.
其中,电子设备例如为个人电脑(Personal Computer,PC),云端设备或者移动设备,移动设备例如智能手机,或者平板电脑等。Among them, the electronic device is, for example, a personal computer (PC), a cloud device or a mobile device, and the mobile device is, for example, a smart phone or a tablet computer.
需要说明的是,本申请实施例的执行主体,在硬件上可以例如为服务器或者电子设备中的中央处理器(Central Processing Unit,CPU),在软件上可以例如为服务器或者电子设备中的后台管理服务,对此不作限制。It should be noted that the execution subject of the embodiments of the present application may be, for example, a server or a central processing unit (CPU) in an electronic device in hardware, and may be, for example, a server or background management in an electronic device in software. Service, there is no restriction on this.
自建基站或共享基站可以给自移动设备提供定位用的实时卫星信号作为参考定位信号,此种定位方式,只从卫星信号角度认为定位误差是恒定值或者误差差异较为微小。而本发明采用的是虚拟基站,即不设置任何能够获取实时卫星信号的自建基站或共享基站,仅仅把某个定位校准点在某个时间点获取的卫星信号作为后续定位用的参考定位信号,比如以自移动设备出发前获取的卫星信号作为后续定位用的参考定位信号。该种定位方式随着时间的累积,定位误差是累计误差,误差会逐渐变大,即随着时间的累计,如果只用定位导航进行定位不借助其他的定位设备,定位会越来越不准确。所以自移动设备会设置误差评估,当评估到误差超过设定的误差设定阈值时,会控制自移动设备返回定位校准点重新获取定位校准点位置的卫星信号,该卫星信号为定位用的新的参考定位信号。Self-built base stations or shared base stations can provide real-time satellite signals for positioning to self-mobile devices as reference positioning signals. In this positioning method, the positioning error is considered to be a constant value or the error difference is relatively small from the perspective of the satellite signal. However, the present invention uses a virtual base station, that is, does not set any self-built base station or shared base station that can obtain real-time satellite signals, and only uses the satellite signal obtained at a certain time point at a certain positioning calibration point as the reference positioning signal for subsequent positioning. For example, the satellite signal obtained before the departure of the mobile device is used as the reference positioning signal for subsequent positioning. This kind of positioning method accumulates with time, the positioning error is a cumulative error, and the error will gradually become larger, that is, with the accumulation of time, if you only use positioning navigation for positioning without using other positioning equipment, the positioning will become more and more inaccurate . Therefore, the self-mobile device will set an error evaluation. When the error exceeds the set error threshold, the self-mobile device will be controlled to return to the positioning calibration point to re-acquire the satellite signal of the positioning calibration point. The satellite signal is a new positioning signal. The reference positioning signal.
如图4所示,自动割草机1具有建图获取的建图边界901,该边界可以是用户手持导航设备绕工作区域的边界行走一圈定位获取,一般考虑到定位误差(可能是累计定位误差,也可以是具有恒定定位误差),为了防止自动割草机1移动出实际的边界,设置了自建图边界901向内缩减一定距离的缓冲区,向内缩减一定距离后形成的边界为缓冲边界902,但是自动割草机1存在定位误差,结合该定位误差,具有最大内边界903,该最大内边界903即为自动割草机1沿边界移动时位于最靠内的位置,由于定位误差的存在,最终自动割草机1沿边界行走会是实际轨迹904的结果,对于采用具有累积误差的方式进行定位,误差会更加明显,会使得边界处理结果不理想,对于智能割草机而言,边界上会有过多的草未被处理。As shown in Figure 4, the automatic lawn mower 1 has a mapping boundary 901 acquired by mapping. The boundary can be obtained by a user's hand-held navigation device walking around the boundary of the working area. Generally, the positioning error (which may be accumulated positioning The error can also be a constant positioning error). In order to prevent the automatic lawn mower 1 from moving out of the actual boundary, a buffer with the self-built map boundary 901 reduced inward by a certain distance is set, and the boundary formed by reducing a certain distance inward is Buffer boundary 902, but the automatic lawn mower 1 has a positioning error. Combined with the positioning error, it has a maximum inner boundary 903. The maximum inner boundary 903 is the innermost position of the automatic lawn mower 1 when it moves along the boundary. In the presence of errors, eventually the automatic lawn mower 1 will walk along the boundary as a result of the actual trajectory 904. For positioning with cumulative errors, the error will be more obvious, which will make the boundary processing results unsatisfactory. In other words, there will be too much grass on the border that has not been processed.
图5是本发明自移动设备的控制方法的流程示意图。如图5所示,该自移动设备的控制方法包括步骤S101至步骤S104。Fig. 5 is a schematic flowchart of a control method from a mobile device of the present invention. As shown in FIG. 5, the control method of the self-mobile device includes step S101 to step S104.
步骤S101:获取工作区域地图上的边界信息。Step S101: Obtain boundary information on the work area map.
其中,所述边界信息可以通过自移动设备内存储的工作区域的地图获取,该地图内的边界可以是用户手持导航设备绕工作区域的边界行走一圈定位获取。Wherein, the boundary information may be obtained from a map of the working area stored in the mobile device, and the boundary in the map may be obtained by positioning the user's handheld navigation device walking around the boundary of the working area.
步骤S102:控制具有累积定位误差的自移动设备在一定位校准点完成位置校准后在边界上移动,并进行边界区域处理工作。Step S102: Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing.
其中,如果在一定位校准点完成位置校准后离开定位校准点向边界移动Among them, if a positioning calibration point is completed and the position calibration is completed, the positioning calibration point is moved to the boundary.
步骤S103:获取自移动设备离开定位校准点后的累积误差衡量值或定位质量值,当累积误差衡量值达到设定的累积误差阈值时或定位质量值达到设定的定位质量阈值时,控制自移动设备停止边界区域处理工作。Step S103: Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point. When the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold, control the self The mobile device stops processing the boundary area.
对于没有安装实体基站的工作环境,自移动设备在移动过程中一直存在定位误差, 且随着自移动设备的不断移动,该定位误差会随着时间累积,最终形成累积定位误差,且随着时间的推移该累积定位误差会越来越大。For a working environment where no physical base station is installed, there is always a positioning error in the mobile device during the movement, and as the mobile device continues to move, the positioning error will accumulate over time, eventually forming a cumulative positioning error, and with time The accumulated positioning error will become larger and larger as time goes by.
本发明自移动设备不采用实体基站进行定位,而采用虚拟基站进行定位。虚拟基站并不是实际存在的基站,而是选择某个特殊的点作为定位校准点,将该定位校准点作为一个基站,虚拟基站的位置即为设定的定位校准点位置,即前述的定位校准点位置,所以所述参考定位信号为自移动设备直接从卫星采集获得而非通过实体基站实时获得。在本发明实施例中,定位校准点的位置为充电站位置或者工作区域内设定的具有固定坐标的位置。采用虚拟基站的定位方法为:获取自移动设备在移动过程中的当前定位信号,自移动设备在所述当前定位信号之前的参考定位信号以及所述参考定位信号的位置信息用于当前位置信息确定。In the present invention, the mobile device does not use a physical base station for positioning, but uses a virtual base station for positioning. The virtual base station is not an actual base station. Instead, a special point is selected as the positioning calibration point, and the positioning calibration point is used as a base station. The position of the virtual base station is the set positioning calibration point position, that is, the aforementioned positioning calibration Point position, so the reference positioning signal is obtained from the mobile device directly from the satellite instead of being obtained in real time through the physical base station. In the embodiment of the present invention, the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area. The positioning method using a virtual base station is as follows: the current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information .
所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值。即累积误差衡量值可以是时间数据或距离数据。对应的累积误差阈值为时间阈值或距离阈值。下面针对该两种累积误差衡量值及对应的累积误差阈值的方案进行进一步的描述。The cumulative error measurement value is the value of time since the mobile device left the positioning calibration point, or the value of the moving distance since the mobile device left the positioning calibration point. That is, the cumulative error measurement value can be time data or distance data. The corresponding cumulative error threshold is a time threshold or a distance threshold. The following further describes the solutions for the two cumulative error measurement values and the corresponding cumulative error threshold.
当所述累积误差衡量值为自移动设备移动的时间数据,所述累积误差阈值为时间阈值。所以对于步骤S103,所述获取自移动设备移动过程中的累积误差衡量值,当累积误差衡量值达到设定的累积误差阈值时,控制自移动设备停止边界区域处理工作,具体包括:When the cumulative error measurement value is time data of movement from the mobile device, the cumulative error threshold value is a time threshold value. Therefore, for step S103, the cumulative error measurement value obtained during the movement of the mobile device, when the cumulative error measurement value reaches the set cumulative error threshold, controlling the mobile device to stop the processing of the boundary area, which specifically includes:
获取自移动设备自定位校准点位置移动到边界位置的时间值A1;Obtained from the time value A1 when the mobile device moves from the position of the self-positioning calibration point to the boundary position;
获取自移动设备沿边界移动的时间值A2;The time value A2 obtained from the mobile device moving along the boundary;
当时间值A1和时间值A2的总和达到设定的时间阈值时,控制自移动设备停止边界区域处理工作。When the sum of the time value A1 and the time value A2 reaches the set time threshold, control the mobile device to stop the boundary area processing.
当所述累积误差衡量值为距离数据,所述累积误差阈值为距离阈值。所以对于步骤S103,所述获取自移动设备移动过程中的累积误差衡量值,当累积误差衡量值达到设定的累积误差阈值时,控制自移动设备停止边界区域处理工作,包括:When the cumulative error measurement value is distance data, the cumulative error threshold value is a distance threshold value. Therefore, for step S103, the cumulative error measurement value obtained during the movement of the mobile device, when the cumulative error measurement value reaches the set cumulative error threshold, controlling the mobile device to stop the boundary area processing work includes:
获取自移动设备自定位校准点位置移动到边界位置的距离值B1;The distance value B1 obtained from the mobile device's self-positioning calibration point position to the boundary position;
获取自移动设备沿边界移动的距离值B2;The distance value B2 obtained from the mobile device moving along the boundary;
当距离值B1和距离值B2的总和达到设定的距离阈值时,控制自移动设备停止边界区域处理工作。When the sum of the distance value B1 and the distance value B2 reaches the set distance threshold, the mobile device is controlled to stop the boundary area processing.
对于步骤S103中的定位质量值具体包括步骤:The positioning quality value in step S103 specifically includes the following steps:
获取自移动设备自定位校准点位置出发后的当前位置信息;Acquire current position information after the mobile device starts from the position of the self-positioning calibration point;
判断当前位置信息的质量是否满足预设定位质量阈值;Determine whether the quality of the current location information meets the preset positioning quality threshold;
若不满足预设定位质量阈值,则控制自移动设备停止边界区域处理工作。If the preset positioning quality threshold is not met, control the mobile device to stop processing the boundary area.
对于存在累积误差的定位方法,自移动设备从定位校准点位置离开后的起始时间段内的误差相对较小,所以定位精度较高,本发明的该自移动设备的控制方法充分利用自移动设备出发后的定位精度最高的时段先对边界进行处理,提升了边界处理的效率及边界处理的效果,解决累计误差导致的边界处理不理想问题。For the positioning method with accumulated error, the error in the initial time period after the mobile device leaves from the positioning calibration point is relatively small, so the positioning accuracy is high. The control method of the self-moving device of the present invention makes full use of the self-moving The boundary is processed first in the time period with the highest positioning accuracy after the device is set off, which improves the efficiency of boundary processing and the effect of boundary processing, and solves the problem of unsatisfactory boundary processing caused by accumulated errors.
如图6所示,上述步骤S103中,如果所述累积误差阈值为定位质量阈值,需要根据自移动设备移动过程中的定位质量信息与设定的定位质量阈值比较,才好判断自移动设备是否满足定位质量阈值要求,同时,自移动设备在移动过程中,不管是对边界区域进 行处理还是对工作区域进行处理,均需要进行位置确定,所以基于虚拟基站自移动设备的位置确定方法具体包括步骤S201至步骤S203。As shown in Figure 6, in the above step S103, if the cumulative error threshold is the positioning quality threshold, it is necessary to compare the positioning quality information during the movement of the self-mobile device with the set positioning quality threshold to determine whether the self-mobile device is To meet the positioning quality threshold requirements, at the same time, when the mobile device is moving, whether it is processing the boundary area or the working area, it needs to determine the position, so the method for determining the position of the mobile device based on the virtual base station specifically includes the steps S201 to step S203.
步骤201:获取自移动设备在移动过程中的当前定位信号,以及自移动设备在所述当前定位信号之前的参考定位信号。Step 201: Acquire the current positioning signal from the mobile device during the movement, and the reference positioning signal from the mobile device before the current positioning signal.
其中,自移动设备可以例如为移动站9或者是安装有移动站9的自移动设备本身,对此不作限制。Among them, the self-moving device may be, for example, the mobile station 9 or the self-moving device itself with the mobile station 9 installed, and there is no restriction on this.
其中,对于进行边界处理的实施例,该当前定位信号可以是自移动设备工作过程中的当前定位信号。对于利用定位技术构建地图的实施例,该当前定位信号也可以是生成地图过程中的当前定位信号。其中生成的地图可以作为自移动设备的工作区域,对此不作限制。可以理解的是,生成地图的方式可以例如,用户在Google地图上圈出自移动设备的工作区域,移动站9与自移动设备一体化设置,自移动设备为自移动设备。自移动设备沿着工作区域运行一圈,例如如果自移动设备为自动割草机,可以是用户推动自动割草机运行,用户遥控自动割草机运行,自动割草机跟随用户移动的轨迹,自动割草机自动运行等,对此不作限制。Wherein, for the embodiment where the boundary processing is performed, the current positioning signal may be the current positioning signal during the operation of the mobile device. For the embodiment that uses positioning technology to construct a map, the current positioning signal may also be the current positioning signal in the process of generating the map. The generated map can be used as the working area of the mobile device, and there is no restriction on this. It is understandable that the way of generating the map can be, for example, the user encircles the working area of the mobile device on the Google map, the mobile station 9 is integrated with the mobile device, and the mobile device is the mobile device. The self-moving device runs a circle along the work area. For example, if the self-moving device is an automatic lawn mower, the user can push the automatic lawn mower to run, and the user remotely controls the operation of the automatic lawn mower, and the automatic lawn mower follows the trajectory of the user's movement. There are no restrictions on the automatic operation of the automatic lawn mower, etc.
在一个实施例中,移动站9与自动割草机分离设置,自移动设备为移动站9。用户手持移动站9沿着工作区域运行一圈,根据移动站9运行过程中采集到的定位信号数据,生成地图。In one embodiment, the mobile station 9 is separated from the automatic lawn mower, and the mobile device is the mobile station 9. The user holds the mobile station 9 and runs a circle along the work area, and generates a map based on the positioning signal data collected during the operation of the mobile station 9.
其中,所述参考定位信号为自移动设备直接从卫星采集获得,而非是自建基站或共享基站传输的同步卫星信号。参考定位信号可以是一个,也可以是多个。Wherein, the reference positioning signal is directly collected from a satellite by a mobile device, rather than a synchronous satellite signal transmitted by a self-built base station or a shared base station. There can be one or more reference positioning signals.
参考定位信号可以有两种获取方式,第一种是直接以定位校准点位置获取的卫星信号作为参考定位信号;第二种是先以当前时刻之前最近时刻收到的卫星信号作为参考定位信号进行解算处理,如果不满足解算条件,则继续选择更前时刻收到的卫星信号作为参考定位信号进行解算处理,以此类推直至获得符合解算条件的卫星信号作为参考定位信号。The reference positioning signal can be obtained in two ways. The first is to directly use the satellite signal obtained at the position of the positioning calibration point as the reference positioning signal; the second is to first use the satellite signal received at the latest time before the current time as the reference positioning signal. Solution processing, if the solution condition is not met, continue to select the satellite signal received at a previous moment as the reference positioning signal for solution processing, and so on until the satellite signal that meets the solution condition is obtained as the reference positioning signal.
下面对于第二种获取参考定位信号的方法进行进一步详细的描述。The second method for obtaining a reference positioning signal will be described in further detail below.
为了获得初始的首个参考定位信号,在获取自移动设备在移动过程中的当前定位信号以及自移动设备在所述当前定位信号之前的参考定位信号的步骤之前,还包括步骤:确定定位校准点位置的参考坐标;获取自移动设备在定位校准点位置的定位信号,将该定位信号作为首个参考定位信号。如上所述,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。In order to obtain the initial first reference positioning signal, before the step of obtaining the current positioning signal from the mobile device during the movement and the reference positioning signal from the mobile device before the current positioning signal, the method further includes the step of determining the positioning calibration point The reference coordinates of the position; the positioning signal obtained from the mobile device at the position of the positioning calibration point, the positioning signal is used as the first reference positioning signal. As described above, the position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area.
对于定位校准点位置的识别,如果定位校准点是充电站,可以直接通过充电对接识别自移动设备已经到达定位校准点,可以获取定位校准点位置的参考定位信号。定位校准点可以通过设置标记信号的方式进行确认,比如磁场或者图像等等。For the identification of the position of the positioning calibration point, if the positioning calibration point is a charging station, it can be directly recognized through the charging docking that the mobile device has reached the positioning calibration point, and the reference positioning signal of the positioning calibration point position can be obtained. The positioning of the calibration point can be confirmed by setting the marking signal, such as magnetic field or image, etc.
以自移动设备为自动割草机1进行描述,当参考定位信号包括一个时,参考定位信号可以选择在预设的定位校准点获取定位校准点的卫星信号获得。对于自动割草机1而言,此处所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。对于其他自移动设备,不需要在工作区域内或者室外设置充电站的,以选定的具有固定的参考坐标的定位校准点或者某个具有固定坐标的物体或停靠点作为定位校准点。本发明实施例中,以自动割草机为例,将充电站或者具有固定的参考坐标的定位校准点作为虚拟基站点,因为充电站或者具有固定的参考坐标的定位校准点可以认为是一个不会变 的物理位置,因此把充电站或者具有固定的参考坐标的定位校准点作为一个虚拟基站点。对于充电站为而言,因为自动割草机1每次都是从充电站出发,并且最后会对接到充电站,所以可以认为充电站是一个不会变的物理位置,因此把充电站作为一个虚拟基站点。自动割草机1每次工作前,把当时的充电站位置接收到的卫星信号作为虚拟基站数据保存在移动站9中,作为参考定位信号。对于具有固定的参考坐标的定位校准点而言,同样的,自动割草机1经过定位校准点时,把当时的定位校准点位置接收到的卫星信号作为虚拟基站数据保存在移动站9中,作为参考定位信号。The self-mobile device is described as the automatic lawn mower 1. When the reference positioning signal includes one, the reference positioning signal can be selected to obtain the satellite signal of the positioning calibration point at the preset positioning calibration point. For the automatic lawn mower 1, the position of the positioning calibration point here is the position of the charging station or the position with fixed coordinates set in the working area. For other self-mobile devices that do not need to set up a charging station in the work area or outdoors, the selected positioning calibration point with fixed reference coordinates or an object or stopping point with fixed coordinates is used as the positioning calibration point. In the embodiment of the present invention, taking the automatic lawn mower as an example, the charging station or the positioning calibration point with fixed reference coordinates is used as the virtual base station point, because the charging station or the positioning calibration point with fixed reference coordinates can be regarded as a non-compliance. The physical location will change, so the charging station or the positioning calibration point with fixed reference coordinates is used as a virtual base station point. For the charging station, because the automatic lawn mower 1 starts from the charging station every time, and will eventually connect to the charging station, it can be considered that the charging station is a physical location that will not change, so the charging station is regarded as a Virtual base station point. Before the automatic lawn mower 1 works, it saves the satellite signal received at the current charging station position as virtual base station data in the mobile station 9 as a reference positioning signal. For the positioning calibration point with fixed reference coordinates, similarly, when the automatic lawn mower 1 passes the positioning calibration point, the satellite signal received at the position of the positioning calibration point at that time is stored in the mobile station 9 as virtual base station data. As a reference positioning signal.
以自移动设备为自动割草机1进行描述,当参考定位信号包括多个时,首个参考定位信号为在预设的定位校准点获取定位校准点的卫星信号获得,其他参考定位信号为自动割草机1在移动过程中获取的具体位置的卫星信号存储获得,即自动割草机1当前位置之前移动范围内获取并存储的卫星信号。Take the mobile device as the automatic lawn mower 1. When the reference positioning signal includes multiple reference positioning signals, the first reference positioning signal is obtained by acquiring the satellite signal of the positioning calibration point at the preset positioning calibration point, and the other reference positioning signals are automatic The satellite signal of the specific position obtained by the lawn mower 1 during the movement is stored and obtained, that is, the satellite signal obtained and stored within the moving range of the automatic lawn mower 1 before the current position.
如图7所示,当参考定位信号包括多个时,获取参考定位信号的方法包括:As shown in FIG. 7, when the reference positioning signal includes multiple reference positioning signals, the method for obtaining the reference positioning signal includes:
S301:选择当前定位信号之前最近时刻的已获取的卫星信号作为参考定位信号;S301: Select the acquired satellite signal at the latest time before the current positioning signal as the reference positioning signal;
S302:判断选择的参考定位信号是否满足解算条件;S302: Determine whether the selected reference positioning signal meets the solution condition;
S303:若选择的参考定位信号满足解算条件,则将该参考定位信号作为后续解算处理的参考定位信号;若选择的参考定位信号不满足解算条件,则选择再前最近时刻的卫星信号作为参考定位信号,并重复步骤S302;S303: If the selected reference positioning signal satisfies the solution condition, use the reference positioning signal as the reference positioning signal for the subsequent solution processing; if the selected reference positioning signal does not meet the solution condition, select the satellite signal at the previous most recent time As a reference positioning signal, and repeat step S302;
S304:重复步骤S303直至获得符合解算条件的参考定位信号。S304: Repeat step S303 until a reference positioning signal that meets the solution condition is obtained.
其中,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值。进一步的。或者,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,且卫星信号的信号质量达到设定的信号噪声比阈值。从以上描述可知,自移动设备优先选择时间最靠近的且符合解算要求的参考定位信号进行解算处理。Wherein, the solution condition is: the number of shared satellites reaches a set threshold for the number of solution satellites. further. Alternatively, the solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signals reaches the set signal-to-noise ratio threshold. It can be seen from the above description that the mobile device preferentially selects the reference positioning signal that is closest in time and meets the solution requirements for solution processing.
在本实施例中,要求充电站或者具有固定的参考坐标的定位校准点最好设在比较开阔的环境下,可以收到比较好的卫星信号。上述虚拟基站数据可以是获得的原始的卫星信号,也可以是经过处理后的卫星信号,不管是原始的卫星信号还是处理后的卫星信号,均不影响后期的信号处理。In this embodiment, it is required that the charging station or the positioning calibration point with fixed reference coordinates is preferably set in a relatively open environment to receive relatively good satellite signals. The above-mentioned virtual base station data may be the obtained original satellite signal or the processed satellite signal. Whether it is the original satellite signal or the processed satellite signal, it will not affect the subsequent signal processing.
以自移动设备为移动站9进行描述,当参考定位信号包括一个时,参考定位信号可以选择在预设的定位校准点获取定位校准点的卫星信号获得。对于自动割草机1而言,此处所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。对于其他自移动设备,不需要在工作区域内或者室外设置充电站的,以选定的具有固定的参考坐标的定位校准点或者某个具有固定坐标的物体或停靠点作为定位校准点。本发明实施例中,以充电站为例,用户从充电站出发,并把当时的充电站位置接收到的卫星信号作为虚拟基站数据保存在移动站9中,作为参考定位信号。对于具有固定的参考坐标的定位校准点而言,同样的,用户从定位校准点出发,把当时的定位校准点位置接收到的卫星信号作为虚拟基站数据保存在移动站9中,作为参考定位信号。Taking the mobile device as the mobile station 9 for description, when the reference positioning signal includes one, the reference positioning signal can be selected to obtain the satellite signal of the positioning calibration point at the preset positioning calibration point. For the automatic lawn mower 1, the position of the positioning calibration point here is the position of the charging station or the position with fixed coordinates set in the working area. For other self-mobile devices that do not need to set up a charging station in the work area or outdoors, the selected positioning calibration point with fixed reference coordinates or an object or stopping point with fixed coordinates is used as the positioning calibration point. In the embodiment of the present invention, taking the charging station as an example, the user starts from the charging station and saves the satellite signal received at the current charging station location as virtual base station data in the mobile station 9 as a reference positioning signal. For the positioning calibration point with fixed reference coordinates, similarly, the user starts from the positioning calibration point and saves the satellite signal received at the position of the positioning calibration point as virtual base station data in the mobile station 9 as a reference positioning signal .
以自移动设备为移动站9进行描述,当参考定位信号包括多个时,首个参考定位信号为在预设的定位校准点获取定位校准点的卫星信号获得,其他参考定位信号为用户手持移动站9移动过程中获取的具体位置的卫星信号存储获得,即移动站9当前位置之前移动范围内获取并存储的卫星信号。Take the mobile device as the mobile station 9 for description. When the reference positioning signal includes multiple reference positioning signals, the first reference positioning signal is obtained by acquiring the satellite signal of the positioning calibration point at the preset positioning calibration point, and the other reference positioning signals are the user's handheld mobile The satellite signal of the specific position obtained during the movement of the station 9 is stored and obtained, that is, the satellite signal obtained and stored within the moving range of the mobile station 9 before the current position.
用户在行进过程中,用户可以直接行走到定位校准点位置并将定位校准点的位置坐 标作为当前的位置坐标,如此可以提高定位精度,进而提升生成地图的准确度。When the user is traveling, the user can directly walk to the position of the positioning calibration point and use the position coordinates of the positioning calibration point as the current position coordinates, which can improve the positioning accuracy and thus the accuracy of the generated map.
步骤202:对所述参考定位信号和所述当前定位信号进行解算处理获得误差数据,进行解算处理的所述参考定位信号和所述当前定位信号存在共用卫星信号。Step 202: Perform calculation processing on the reference positioning signal and the current positioning signal to obtain error data, and the reference positioning signal subjected to the calculation processing and the current positioning signal have a common satellite signal.
其中,当所述参考定位信号和所述当前定位信号不存在共用卫星信号时,将无法进行解算处理,随着自移动设备的移动如果在预设的条件下仍旧无法获得共用卫星信号时,自移动设备需要重新回到定位校准点获取新的参考定位信号。如果自移动设备是自移动设备,则自移动设备可以自行返回定位校准点位置,如果自移动设备是移动站9,则需要提醒用户返回定位校准点,提醒用户的方式可以为报警或者停机等等。预设的条件可以为预设的丢掉共用卫星的时间或者无法进行解算的时间。Wherein, when the reference positioning signal and the current positioning signal do not have a shared satellite signal, the solution processing cannot be performed. As the mobile device moves, if the shared satellite signal is still not available under preset conditions, Since the mobile device needs to return to the positioning calibration point to obtain a new reference positioning signal. If the self-mobile device is a self-mobile device, the self-mobile device can return to the positioning calibration point position by itself. If the self-mobile device is a mobile station 9, the user needs to be reminded to return to the positioning calibration point. The way to remind the user can be alarm or shutdown, etc. . The preset condition may be the preset time when the shared satellite is lost or the time when the solution cannot be performed.
为了能够具有更好的定位效果,预设有解算卫星数阈值。对于参考定位信号只有一个的情况,当共用卫星数量达到设定的解算卫星数阈值时,所述参考定位信号和所述当前定位信号进行解算处理。当共用卫星数量没有达到设定的解算卫星数阈值时,随着自移动设备的移动如果在预设的条件下仍旧无法获得共用卫星信号时,自移动设备重新回到定位校准点获取新的参考定位信号。解算卫星数最少为7-8颗,卫星数太少将无法进行解算处理获取位置信息,当然,解算卫星数也不可太多,太多对移动设备的运算能力要求会增高,成本也会增加。在一个实施例中,解算卫星数为13-14颗,该范围内的卫星数满足解算要求且一般移动设备在不需要高成本的条件下的硬件和软件支持的运算能力能解决卫星运算。In order to have a better positioning effect, a threshold for the number of satellites to be solved is preset. For the case where there is only one reference positioning signal, when the number of shared satellites reaches the set threshold of the number of resolved satellites, the reference positioning signal and the current positioning signal are subjected to calculation processing. When the number of shared satellites does not reach the set threshold for solving satellites, as the mobile device moves, if the shared satellite signal is still not available under preset conditions, the mobile device returns to the positioning calibration point to obtain a new one. Reference positioning signal. The number of satellites to be solved is at least 7-8. If the number of satellites is too small, it will not be possible to perform the calculation process to obtain position information. Of course, the number of satellites can not be too many. increase. In one embodiment, the number of satellites to be solved is 13-14, the number of satellites in this range meets the requirements of the solution, and the computing power supported by hardware and software of general mobile devices can solve satellite computing without high cost. .
对于参考定位信号具有多个的情况,选择进行解算处理的参考定位信号为当前时刻之前且距离当前时刻最近的时刻获取的卫星信号,并且优先选择共用卫星数量多的参考定位信号进行解算处理。具体的,当选择的当前时刻之前且距离当前时刻最近的时刻的参考定位信号与当前时刻的卫星信号之间的共用卫星数量达到设定的解算卫星数阈值时,所述参考定位信号和所述当前定位信号进行解算处理,相反,如果没有达到设定的解算卫星数阈值时,选择时间再往前的其他参考定位信号进行共用卫星数量分析,直到存在达到设定的解算卫星数阈值的参考定位信号存在,然后进行解算处理。如果自移动设备在预设的条件下仍旧无法获得共用卫星信号时,自移动设备重新回到定位校准点获取新的参考定位信号。自移动设备出去工作后,将移动站9实时接收到的卫星信号和虚拟基站(即充电站或者具有固定的参考坐标的定位校准点)接收到的参考定位信号进行解算处理,得到一个高精度定位数据。当回到定位校准点后,将存储的虚拟基站的卫星信号清除,等到下次工作时再记录当时的虚拟基站的卫星信号作为参考定位信号。For the situation where there are multiple reference positioning signals, the reference positioning signal selected for the solution processing is the satellite signal obtained before the current time and the closest to the current time, and the reference positioning signal with a large number of shared satellites is preferentially selected for the solution processing . Specifically, when the number of shared satellites between the selected reference positioning signal at the time closest to the current time and the satellite signal at the current time reaches the set threshold for the number of resolved satellites, the reference positioning signal and all satellites The current positioning signal is solved for processing. On the contrary, if it does not reach the set threshold of the number of solved satellites, other reference positioning signals before the time are selected for the analysis of the number of shared satellites, until the number of solved satellites is reached. The threshold value of the reference positioning signal exists, and then the solution is processed. If the self-mobile device still cannot obtain the shared satellite signal under the preset conditions, the self-mobile device returns to the positioning calibration point to obtain a new reference positioning signal. After the mobile device goes out to work, the satellite signal received by the mobile station 9 in real time and the reference positioning signal received by the virtual base station (that is, the charging station or the positioning calibration point with fixed reference coordinates) are processed to obtain a high-precision Positioning data. After returning to the positioning calibration point, the stored satellite signal of the virtual base station is cleared, and the satellite signal of the virtual base station at that time will be recorded as the reference positioning signal until the next work.
所述解算条件为:共用卫星数量达到设定的解算卫星数阈值。另外,除了卫星数的要求,对卫星信号本身的信号质量也需要满足一定的要求,所以进一步的所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,且卫星信号的信号质量达到设定的信号噪声比阈值。The solution condition is: the number of shared satellites reaches a set threshold for the number of solution satellites. In addition, in addition to the requirement of the number of satellites, the signal quality of the satellite signal itself also needs to meet certain requirements, so the further calculation conditions are: the number of shared satellites reaches the set threshold of the number of satellites to be resolved, and the signal of the satellite signal The quality reaches the set signal-to-noise ratio threshold.
步骤203:根据所述误差数据及所述参考定位信号的位置信息处理获得自移动设备的当前位置信息。Step 203: According to the error data and the position information of the reference positioning signal, the current position information obtained from the mobile device is processed.
由于电离层、环境等还是会缓慢变化,自移动设备工作时间长后,定位精度会慢慢下降。所以,需要对定位精度有一个误差评估,该误差评估可以根据地理位置、定位工作时间、当时的实际时间等信息来评判。所以,所述的自移动设备的控制方法还包括:对处理获得的自移动设备的当前位置信息进行误差评估;和,当误差评估结果满足误差 条件时,自移动设备返回定位校准点重新获取初始的参考定位信号。自移动设备返回定位校准点重新获取初始的参考定位信号时,清除自移动设备保存的所有非当前定位信号。所述定位校准点位置为充电站位置或者自移动设备的工作区域内设定的具有固定的参考坐标的定位校准点。所述误差条件为:自移动设备的工作时间达到设定的总工作时间阈值。所述误差条件还可以为:选择的参考定位信号不满足解算条件,其中,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值。进一步的所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,且卫星信号的信号质量达到设定的信号噪声比阈值。Since the ionosphere, environment, etc. still change slowly, the positioning accuracy will slowly decrease after the mobile device has been working for a long time. Therefore, it is necessary to have an error assessment of the positioning accuracy, which can be judged based on information such as geographic location, positioning working time, and actual time at that time. Therefore, the control method of the self-mobile device further includes: performing error evaluation on the current position information of the self-mobile device obtained by processing; and, when the error evaluation result meets the error condition, returning from the mobile device to the positioning calibration point to re-acquire the initial The reference positioning signal. When returning to the positioning calibration point from the mobile device to re-acquire the initial reference positioning signal, all non-current positioning signals saved from the mobile device are cleared. The position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device. The error condition is: the working time of the mobile device reaches the set total working time threshold. The error condition may also be: the selected reference positioning signal does not meet the solution condition, where the solution condition is: the number of shared satellites reaches a set threshold for the number of resolved satellites. Further, the solution condition is that the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signals reaches the set signal-to-noise ratio threshold.
总体来说,设定误差条件的方法可以采用下面的方法进行设定,如果自移动设备为自移动设备,则设定误差阈值的方法可以为:自移动设备离开定位校准点的时间范围值、所述参考定位信号和所述当前定位信号无法进行解算处理的时间范围值、规定的工作时间范围值、丢掉共用卫星的时间范围值。如果自移动设备为移动站9,则设定误差阈值的方法可以为:所述参考定位信号和所述当前定位信号无法进行解算处理的时间范围值、丢掉共用卫星的时间范围值等等。Generally speaking, the method of setting the error condition can be set by the following method. If the self-mobile device is a self-mobile device, the method of setting the error threshold can be: the time range value of the self-mobile device leaving the positioning calibration point, The reference positioning signal and the time range value for which the current positioning signal cannot be resolved, the specified working time range value, and the time range value for losing the shared satellite. If the mobile device is the mobile station 9, the method for setting the error threshold may be: the time range value for which the reference positioning signal and the current positioning signal cannot be resolved, the time range value for discarding the shared satellite, and so on.
为了能够提高自移动设备的工作效率及定位的准确度,在一个实施例中,在自移动设备的工作区域内设置有多个具有固定的参考坐标的定位校准点,多个所述定位校准点相互之间具有已知的固定的参考坐标,当自移动设备移动到定位校准点位置时,所述自移动设备将定位校准点的位置信息作为当前位置信息。比如图1及图3所示的定位校准点A和定位校准点B,当自移动设备移动到定位校准点位置时,自移动设备将定位校准点的位置信息作为当前位置信息,如此设置,可以对自移动设备的位置坐标进行修正。这些标记可以采用RFID、霍尔传感器等方式,通过对该些固定定位校准点进行手动或自动标记,使其获得一个固定的参考坐标(比如充电站为(0,0)点的话,物理定位校准点就是(x,y)点),每次当自移动设备走到该些物理定位校准点时,直接将该物理定位校准点的坐标作为当前的坐标。In order to improve the working efficiency and positioning accuracy of the self-mobile device, in one embodiment, a plurality of positioning calibration points with fixed reference coordinates are provided in the working area of the self-mobile device, and a plurality of the positioning calibration points There are known fixed reference coordinates between each other. When the self-mobile device moves to the position of the positioning calibration point, the self-mobile device uses the position information of the positioning calibration point as the current position information. For example, positioning calibration point A and positioning calibration point B shown in Figure 1 and Figure 3, when the mobile device moves to the position of the positioning calibration point, the mobile device will use the position information of the positioning calibration point as the current position information. Correct the position coordinates of the mobile device. These marks can use RFID, Hall sensors, etc., by manually or automatically marking the fixed positioning calibration points to obtain a fixed reference coordinate (for example, if the charging station is (0, 0) point, physical positioning calibration The point is the (x, y) point), and each time the mobile device walks to these physical positioning calibration points, the coordinates of the physical positioning calibration point are directly used as the current coordinates.
当用户家比较大时,自移动设备可以构建出工作区域地图,通过优化分区方式来提高工作效率。具体的实施步骤是把工作区域分成多个子区域,每个区域的工作模式是:自移动设备工作前,把当时的定位校准点,比如充电站位置接收到的卫星信号作为虚拟基站数据保存在移动站9中,自移动设备出去工作后保存工作过程中收到的所有卫星信号,该些所有卫星信号均可作为虚拟基站数据进行计算使用,通过将移动站9实时接收到的当前卫星信号和虚拟基站数据(包括充电站处的卫星信号以及工作过程中当前时刻之前接收到并存储的其他卫星信号)进行解算处理,得到一个高精度定位数据。工作完后回到充电站重新修订虚拟基站数据,再到下一个区域工作。在任何一个子区域工作时,可以实时进行误差评估。对于子区域面积仍旧较大时,同样可以设置多个具有固定的参考坐标的定位校准点对数据进行修正,得到更高精度定位数据。When the user's home is relatively large, a map of the work area can be constructed from the mobile device, and work efficiency can be improved by optimizing the partitioning method. The specific implementation step is to divide the working area into multiple sub-areas. The working mode of each area is: before the mobile device works, the current positioning calibration point, such as the satellite signal received at the charging station position, is stored as virtual base station data in the mobile device. In station 9, all satellite signals received during the work process are saved after the mobile device goes out to work. All satellite signals can be used as virtual base station data for calculation and use. By combining the current satellite signals received by the mobile station 9 in real time and the virtual The base station data (including the satellite signal at the charging station and other satellite signals received and stored before the current time in the working process) is processed to obtain a high-precision positioning data. After the work is completed, return to the charging station to revise the virtual base station data, and then work in the next area. When working in any sub-area, error evaluation can be carried out in real time. When the area of the sub-region is still large, multiple positioning calibration points with fixed reference coordinates can also be set to correct the data to obtain higher-precision positioning data.
本发明通过利用当前定位信号之前的参考定位信号获取误差数据并基于该误差数据及该参考定位信号的位置信息处理获得当前位置信息,并未利用自建基站或共享基站在当前时刻实时收到的卫星信号进行处理而获得当前位置信息,所以基于本发明可以取消自建基站或共享基站,简化用户安装,大幅降低成本。The present invention obtains the error data by using the reference positioning signal before the current positioning signal and obtains the current position information based on the error data and the position information processing of the reference positioning signal, and does not use the self-built base station or the shared base station received in real time at the current moment. Satellite signals are processed to obtain current position information, so based on the present invention, self-built base stations or shared base stations can be eliminated, user installation is simplified, and costs are greatly reduced.
基于前述对多个参考定位信号的描述,所以本发明在步骤101之前,即在获取工作区域地图上的边界信息的步骤之前,还包括步骤:Based on the foregoing description of multiple reference positioning signals, the present invention, before step 101, that is, before the step of obtaining boundary information on the work area map, further includes the following steps:
确定定位校准点位置的参考坐标;Determine the reference coordinates of the positioning calibration point;
获取自移动设备在定位校准点位置的定位信号,将该定位信号作为首个参考定位信号。The positioning signal obtained from the mobile device at the position of the positioning calibration point is used as the first reference positioning signal.
基于前述单个参考定位信号的描述,所以本发明在步骤101之前,即在获取工作区域地图上的边界信息的步骤之前,还包括步骤:Based on the foregoing description of the single reference positioning signal, the present invention, before step 101, that is, before the step of obtaining boundary information on the work area map, further includes the following steps:
确定定位校准点位置的参考坐标,所述参考定位信号为定位校准点位置的定位信号,所述参考定位信号的位置信息为参考坐标。The reference coordinates of the position of the positioning calibration point are determined, the reference positioning signal is a positioning signal for positioning the position of the calibration point, and the position information of the reference positioning signal is the reference coordinate.
本发明自移动设备利用定位精度最高的时段对边界进行处理,处理结束准备停止边界区域处理工作时,具有两种不同的后续行为逻辑,该两种不同的行为逻辑体现了两种不同的边界处理方法。The invention uses the time period with the highest positioning accuracy to process the boundary from the mobile device, and when the processing is finished and prepares to stop the processing of the boundary area, it has two different subsequent behavior logics. The two different behavior logics reflect two different boundary processing. method.
第一种行为逻辑是:自移动设备单独专门的对边界进行处理,可以是在工作区域处理结束后进行,也可以是在工作区域处理开始前进行,本行为逻辑具体是,自移动设备停止边界区域处理工作后,自移动设备直接返回定位校准点位置重新获取参考定位信号,然后再次回到上一个终止的边界位置继续移动并对边界进行处理,然后重复相关的累积误差阈值判断及停止边界区域处理工作步骤,如此循环直至最终完成一次完整的边界处理。如图8所示,自移动设备可以从定位校准点位置A出发,朝边界方向移动到达边界的P1位置,P1位置为第一个切割起点,沿边界移动一段距离至P2位置,此时判断累积误差衡量值达到设定的累积误差阈值时,自移动设备停止移动并自P2位置返回定位校准点位置A重新获取参考定位信号,P2位置为第一个切割终点也是第二个切割起点,自移动设备重新获取参考定位信号后重新从定位校准点位置A出发回到P2位置并继续沿边界移动至P3位置,此时判断累积误差衡量值达到设定的累积误差阈值时,自移动设备停止移动并返回定位校准点位置A重新获取参考定位信号,P3位置为第二个切割终点也是第三个切割起点,以此方式循环直至自移动设备完成一次完整的边界处理。The first kind of behavior logic is: the mobile device processes the boundary separately, which can be performed after the processing of the work area is finished, or before the processing of the work area starts. The specific logic of this behavior is to stop the boundary from the mobile device. After the area processing work, the mobile device directly returns to the position of the positioning calibration point to obtain the reference positioning signal, and then returns to the last terminated boundary position to continue moving and processing the boundary, and then repeat the relevant cumulative error threshold judgment and stop the boundary area Processing the work steps, and so on until the final completion of a complete boundary processing. As shown in Figure 8, the self-mobile device can start from the positioning calibration point position A, move toward the boundary to reach the P1 position of the boundary. The P1 position is the first cutting starting point, and move a distance along the boundary to the P2 position. At this time, it is judged to accumulate When the error measurement value reaches the set cumulative error threshold, the mobile device stops moving and returns to the positioning calibration point position A from the P2 position to obtain the reference positioning signal again. The P2 position is the first cutting end point and the second cutting start point, and it moves automatically. After reacquiring the reference positioning signal, the device re-starts from the positioning calibration point position A, returns to the P2 position and continues to move along the boundary to the P3 position. At this time, when the cumulative error measurement value reaches the set cumulative error threshold, the mobile device stops moving and Return to the positioning calibration point position A to obtain the reference positioning signal again. The P3 position is the second cutting end point and the third cutting start point. In this way, it loops until the mobile device completes a complete boundary processing.
第二种行为逻辑是,自移动设备在工作过程中进行边界处理,自移动设备每次从定位校准点位置出发都会先利用该定位精度最高的时段对边界进行处理,然后再返回工作区域进行常规的工作,如此循环直至最终完成一次完整的边界处理。下面结合附图对不同的行为逻辑进行叙述。如图9所示,自移动设备可以从定位校准点位置A出发,朝边界方向移动到达边界的F1位置,F1位置为第一个切割起点,沿边界移动一段距离至F2位置,此时判断累积误差衡量值达到设定的累积误差阈值时,自移动设备停止移动并自F2位置最近的待工作区域H2(工作区域H1虽然离F2位置较近,但是属于已被处理完成的工作区域),到达待工作区域H2的F3位置,自F3位置开始按照工作逻辑对工作区域H2进行处理,当自移动设备满足返回定位校准点位置的预设条件时,控制自移动设备返回定位校准点位置A重新获取参考定位信号,本实施例中,自移动设备完成了对工作区域H2的处理,从处理结束的终点F4位置返回定位校准点位置A,自移动设备返回定位校准点位置A后,当判断自移动设备还未完成一次完整的边界处理时,在定位校准点位置A重新获取参考定位信号,并朝向边界移动并到达F2位置,然后继续沿边界进行移动并对边界进行处理,当判断累积误差衡量值达到设定的累积误差阈值时,自移动设备停止移动,同时判断是否存在待工作区域,如果存在朝向待工作区域移动,如果不存在,自移动设备返回定位校准点位置A重新获取参考定位信号,然后继续回到刚刚边界的终点位置继续进行边界处理,以此方式循环直至自移动设备完成一次完整的边界处理。The second kind of behavior logic is that the mobile device performs boundary processing during the work process, and each time the mobile device starts from the positioning calibration point position, it will first use the time period with the highest positioning accuracy to process the boundary, and then return to the work area for routine The work of this cycle continues until the final completion of a complete boundary processing. The different behavior logics are described below in conjunction with the drawings. As shown in Figure 9, the self-mobile device can start from the positioning calibration point position A and move towards the boundary to reach the F1 position of the boundary. The F1 position is the first cutting starting point, and move a certain distance along the boundary to the F2 position. At this time, it is judged to accumulate When the error measurement value reaches the set cumulative error threshold, since the mobile device stops moving and is closest to the working area H2 from the F2 position (the working area H1 is closer to the F2 position, but belongs to the working area that has been processed). At the F3 position of the working area H2, the working area H2 will be processed according to the working logic starting from the F3 position. When the self-mobile device meets the preset conditions for returning to the positioning calibration point position, control the self-mobile device to return to the positioning calibration point position A to re-acquire With reference to the positioning signal, in this embodiment, the mobile device completes the processing of the working area H2, and returns to the positioning calibration point position A from the end point F4 of the processing. After the mobile device returns to the positioning calibration point position A, when it is judged to be self-moving When the equipment has not completed a complete boundary processing, re-acquire the reference positioning signal at the positioning calibration point position A, move toward the boundary and reach the F2 position, and then continue to move along the boundary and process the boundary. When the cumulative error measurement value is judged When the set cumulative error threshold is reached, the self-mobile device stops moving, and at the same time, it is judged whether there is a waiting area, if there is a movement toward the waiting area, if not, the self-mobile device returns to the positioning calibration point position A to obtain the reference positioning signal again. Then continue to return to the end position of the boundary just now to continue boundary processing, and loop in this way until the mobile device completes a complete boundary processing.
如图10所示,图10为停止边界区域处理工作后的第一种行为逻辑的示意图。在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤S401至步骤S406。As shown in FIG. 10, FIG. 10 is a schematic diagram of the first behavior logic after the boundary region processing is stopped. After the step of controlling the mobile device to stop the processing of the boundary area, the method further includes step S401 to step S406.
S401:判断自移动设备是否完成预设任务,若是则执行S406,否则,则执行S402。S401: Determine whether the mobile device has completed the preset task, if yes, execute S406, otherwise, execute S402.
在一个实施例中,所述预设任务为:自移动设备完成预设的边界处理路径。如图4所示,自移动设备具有建图边界901,还具有最大内边界903。在自移动设备进行边界区域处理工作之前,会先对建图边界901与最大内边界903之间的区域进行路径规划,在一个实施例中,路径规划后的结果是一条螺旋形的路径,从建图边界901朝向最大内边界903方向逐渐内缩,螺旋半径逐渐缩小,或者从最大内边界903朝向建图边界901逐渐外扩,螺旋半径逐渐变大,通过该处理方式,可以确保最大程度的边界区域处理。所述预设的边界处理路径根据自移动设备的切割宽度及边界区域处理工作的处理宽度确定。切割宽度即是刀盘的宽度,而边界区域处理工作的处理宽度为所述建图边界901与最大内边界之间903之间的距离。在特殊情况下,如果边界区域处理工作的处理宽度小于切割宽度,那么自移动设备进行一个周向的绕边界的移动。但是一般情况下,边界区域处理工作的处理宽度均是大于切割宽度的,所以自移动设备的移动路径设置为螺旋形,这样从路径上看,自移动设备像是绕边界N圈,只是该N圈并非同心圆,而是连续的螺旋。In one embodiment, the preset task is: completing the preset boundary processing path from the mobile device. As shown in FIG. 4, the self-mobile device has a mapping boundary 901 and a maximum inner boundary 903. Before processing the boundary area from the mobile device, the area between the mapping boundary 901 and the maximum inner boundary 903 will be routed. In one embodiment, the result of the route planning is a spiral path. The mapping boundary 901 gradually shrinks in the direction of the maximum inner boundary 903, and the spiral radius gradually decreases, or gradually expands from the maximum inner boundary 903 toward the mapping boundary 901, and the spiral radius gradually becomes larger. This processing method can ensure the maximum Border area processing. The preset boundary processing path is determined according to the cutting width of the mobile device and the processing width of the boundary area processing work. The cutting width is the width of the cutter head, and the processing width of the boundary area processing is the distance between the mapping boundary 901 and the maximum inner boundary 903. In special cases, if the processing width of the boundary area processing work is less than the cutting width, then the mobile device performs a circumferential movement around the boundary. But in general, the processing width of the boundary area processing work is larger than the cutting width, so the moving path of the self-mobile device is set to a spiral shape, so from the perspective of the path, the self-mobile device seems to go around the boundary N circles, but the N The circles are not concentric circles, but continuous spirals.
在另一个实施例中,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。在另一个实施例中,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和。In another embodiment, the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area. In another embodiment, the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
S402:控制自移动设备返回定位校准点位置重新获取定位用的参考定位信号。S402: Control the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning.
定位校准点位置为充电站位置或者自移动设备的工作区域内设定的具有固定的参考坐标的定位校准点。自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device. The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S403:控制自移动设备自定位校准点位置再次向边界方向出发并移动到上一个终止点位置后继续沿边界移动。S403: Control the self-locating calibration point position of the self-mobile device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
上一个终止点位置为自移动设备较近一次停止边界区域处理工作的离开位置,该位置并不一定是位置完全吻合的位置,只要是在上一个终止点位置附近1米的范围内均认为是上一个终止点位置。The last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
S404:获取自移动设备再次出发后移动过程中的累积误差衡量值。S404: Acquire a cumulative error measurement value during the moving process after the mobile device starts again.
自移动设备离开定位校准点位置后,会持续记录出发后移动过程中的累积误差衡量值,该累积误差衡量值可以使前述的时间、距离或者位置信息的质量。Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
S405:判断累积误差衡量值是否达到设定的累积误差阈值,若是,则控制自移动设备停止边界区域处理工作并执行S401,否则,控制自移动设备继续沿边界移动。S405: Determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute S401; otherwise, control the mobile device to continue to move along the boundary.
S406:结束边界区域处理工作任务。S406: End the boundary area processing task.
结束边界区域处理工作任务之后,自移动设备可以继续到工作区域进行常规的工作,也可以回到充电站位置或者定位校准点位置等待下次工作。After finishing the work task in the boundary area, the self-mobile device can continue to the work area for regular work, or return to the charging station position or locate the calibration point position and wait for the next work.
如图11所示,在另一个实施例中,所述预设任务为:自移动设备完成预设的边界处理路径。该边界区域处理路径可以为基于建图边界901及最大内边界903设置的绕边界一周的周向移动路径,为了能够达到更好的边界处理效果,基于建图边界901及最大内 边界903之间的距离及切割宽度之间的关系,可以设置多个周向移动路径,该多个周向移动路径可以存在重叠区,当然,最优的方案是移动路径尽量不同,如此设置,可以保证对边界区域的处理效果。As shown in FIG. 11, in another embodiment, the preset task is: completing the preset boundary processing path from the mobile device. The boundary area processing path can be a circumferential movement path around the boundary set based on the mapping boundary 901 and the maximum inner boundary 903. In order to achieve a better boundary processing effect, it is based on the mapping boundary 901 and the maximum inner boundary 903. The relationship between the distance and the cutting width can be set with multiple circumferential moving paths. The multiple circumferential moving paths may have overlapping areas. Of course, the optimal solution is to have different moving paths as much as possible. This setting can ensure that the boundary The treatment effect of the area.
设置多个周向移动路径,即自移动设备在完成预设任务后,继续以相同步骤进行N个周向移动路径的边界处理,N≥1,结合不同的刀盘切割宽度,在一个实施例中,N=4,在另一个实施例中,N=5。N个周向移动路径的所述边界处理相互之间存在处理重叠区。该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点可以方向不同,比如,第一次边界处理时的边界起始点方向与第二次边界处理时的边界起始点方向不同。为了达到更好的边界处理效果,该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点位置至少部分不同,比如,第一次边界处理时的边界起始点位置与第二次边界处理时的边界起始点位置不同,如果假设第一次边界处理形成第一圈,第二次边界处理形成第二圈,认为至少部分同一方向上的点位置不同,即第一圈和第二圈中圈上同一方向的点至定位校准点位置的距离不同。Set multiple circumferential movement paths, that is, after the mobile device completes the preset task, continue to perform boundary processing of N circumferential movement paths in the same step, N≥1, combined with different cutter head cutting widths, in one embodiment In another embodiment, N=4. In another embodiment, N=5. There is a processing overlap area between the boundary processing of the N circumferential movement paths. For the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position point on the boundary, the direction may be different. For example, the direction of the boundary starting point during the first boundary processing is different from that of the second boundary processing. The direction of the starting point of the boundary is different during boundary processing. In order to achieve a better boundary processing effect, the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing The position of the boundary starting point is different from that of the second boundary processing. If it is assumed that the first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction The position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different.
如图12所示,在图12中示意出N=3,自移动设备在边界上的不同位置进行工作形成3次周向移动路径的边界处理。自移动设备可以预设处理次数阈值,当自移动设备获知已经达到预设处理次数阈值时,则结束边界区域处理工作任务。As shown in FIG. 12, in FIG. 12, it is shown that N=3, and the boundary processing of the circumferential movement path is formed by the mobile device working at different positions on the boundary. The mobile device can preset the processing times threshold, and when it is learned from the mobile device that the predetermined processing times threshold has been reached, the boundary area processing task is ended.
如图11所示,具体的,所述自移动设备停止边界区域处理工作的步骤之后,还包括步骤S501至步骤S506。As shown in FIG. 11, specifically, after the step of stopping the processing of the boundary area from the mobile device, it further includes step S501 to step S506.
S501:判断自移动设备是否完成N个周向移动路径的边界处理,若是,则执行S506,否则,则执行S502。S501: Determine whether the self-mobile device has completed boundary processing of N circumferential movement paths, if yes, execute S506, otherwise, execute S502.
完成的N个周向移动路径的边界处理可以存在处理重叠区。There may be a processing overlap area in the boundary processing of the completed N circumferential movement paths.
S502:控制自移动设备返回定位校准点位置重新获取定位用的参考定位信号。S502: Control the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning.
所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area. The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S503:控制自移动设备自定位校准点位置再次向边界方向出发并移动到上一个终止点位置后继续沿边界移动。S503: Control the self-moving device to start again in the direction of the boundary from the position of the self-locating calibration point and move to the position of the last termination point, and then continue to move along the boundary.
上一个终止点位置为自移动设备较近一次停止边界区域处理工作的离开位置,该位置并不一定是位置完全吻合的位置,只要是在上一个终止点位置附近1米的范围内均认为是上一个终止点位置。The last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
S504:获取自移动设备再次出发后移动过程中的累积误差衡量值。S504: Acquire a cumulative error measurement value during the movement process since the mobile device starts again.
自移动设备离开定位校准点位置后,会持续记录出发后移动过程中的累积误差衡量值,该累积误差衡量值可以使前述的时间、距离或者位置信息的质量。Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
S505:判断累积误差衡量值是否达到设定的累积误差阈值,若是,则控制自移动设备停止边界区域处理工作并执行S501,否则,控制自移动设备继续沿边界移动。S505: Determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute S501; otherwise, control the mobile device to continue to move along the boundary.
S506:结束边界区域处理工作任务。S506: End the boundary area processing task.
结束边界区域处理工作任务之后,自移动设备可以继续到工作区域进行常规的工作,也可以回到充电站位置或者定位校准点位置等待下次工作。After finishing the work task in the boundary area, the self-mobile device can continue to the work area for regular work, or return to the charging station position or locate the calibration point position and wait for the next work.
上述N个周向移动路径的边界处理中,以某一个方向为起点,对于同一个方向终点而言,自移动设备尽量位于同一方向上的边界上的不同位置,即自移动设备在不同的周向移动路径的边界处理中在同一方向上位于边界的不同位置上,如此设置,可以保证同 一方向上的边界位置可以被最大限度的处理,进而提高整个边界的处理效果。N个周向移动路径的边界处理中,每个周向移动路径的边界处理的位于边界上的起点方向也可以是不同的,即N个边界处理可以具有N个边界起始移动方向及N个边界起始工作位置,不管如何选择,N个边界处理相互之间存在处理重叠区。In the above-mentioned boundary processing of the N circumferential movement paths, a certain direction is taken as the starting point. For the end point of the same direction, the self-mobile device is located at different positions on the boundary in the same direction as far as possible, that is, the self-mobile device is in different circumferences. In the boundary processing of the moving path, they are located at different positions of the boundary in the same direction. This setting can ensure that the boundary positions in the same direction can be processed to the maximum extent, thereby improving the processing effect of the entire boundary. In the boundary processing of N circumferential movement paths, the starting point direction on the boundary of the boundary processing of each circumferential movement path can also be different, that is, N boundary processing can have N boundary starting movement directions and N Regardless of the selection of the starting working position of the boundary, there is a processing overlap area between the N boundary processings.
如图13所示,图13为停止边界区域处理工作后的第二种行为逻辑的示意图。在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤601至步骤S609。As shown in FIG. 13, FIG. 13 is a schematic diagram of the second behavior logic after the boundary region processing is stopped. After the step of controlling the mobile device to stop the processing of the boundary area, step 601 to step S609 are further included.
S601:判断自移动设备是否存在待工作区域,若是,则执行S602,否则,则执行S604。S601: Determine whether the self-mobile device has an area to be worked, if yes, execute S602, otherwise, execute S604.
如果存在工作区域,自移动设备可以返回距离最近的工作区域进行工作。If there is a work area, the self-mobile device can return to the nearest work area for work.
S602:控制自移动设备返回待工作区域进行工作。S602: Control the mobile device to return to the waiting area for work.
S603:判断自移动设备是否满足返回定位校准点位置的预设条件,若是,则执行S604,否则,控制自移动设备继续工作。S603: Determine whether the self-mobile device satisfies the preset condition for returning to the position of the positioning calibration point, if yes, execute S604; otherwise, control the self-mobile device to continue working.
返回定位校准点位置的预设条件为自移动设备完成了所在工作区域的工作或者自移动设备电量不足或者误差评估结果表明定位误差较大需要重新回定位校准点位置重新获取新的定位用的参考定位信号。The preset condition for returning to the position of the positioning calibration point is that the mobile device has completed the work in the working area or the power of the mobile device is insufficient or the error evaluation result indicates that the positioning error is large. It is necessary to reposition the calibration point position to obtain a new positioning reference Positioning signal.
S604:控制自移动设备返回定位校准点。S604: Control the self-mobile device to return to the positioning calibration point.
自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S605:判断自移动设备是否完成预设任务,若是,则执行S609,否则,则执行S606。S605: Determine whether the self-mobile device has completed the preset task, if yes, execute S609, otherwise, execute S606.
在一个实施例中,所述预设任务为:自移动设备完成预设的边界处理路径。如图4所示,自移动设备具有建图边界901,还具有最大内边界903。在自移动设备进行边界区域处理工作之前,会先对建图边界901与最大内边界903之间的区域进行路径规划,在一个实施例中,路径规划后的结果是一条螺旋形的路径,从建图边界901朝向最大内边界903方向逐渐内缩,螺旋半径逐渐缩小,或者从最大内边界903朝向建图边界901逐渐外扩,螺旋半径逐渐变大,通过该处理方式,可以确保最大程度的边界区域处理。所述预设的边界处理路径根据自移动设备的切割宽度及边界区域处理工作的处理宽度确定。切割宽度即是刀盘的宽度,而边界区域处理工作的处理宽度为所述建图边界901与最大内边界之间903之间的距离。在特殊情况下,如果边界区域处理工作的处理宽度小于切割宽度,那么自移动设备进行一个周向的绕边界的移动。但是一般情况下,边界区域处理工作的处理宽度均是大于切割宽度的,所以自移动设备的移动路径设置为螺旋形,这样从路径上看,自移动设备像是绕边界N圈,只是该N圈并非同心圆,而是连续的螺旋。In one embodiment, the preset task is: completing the preset boundary processing path from the mobile device. As shown in FIG. 4, the self-mobile device has a mapping boundary 901 and a maximum inner boundary 903. Before processing the boundary area from the mobile device, the area between the mapping boundary 901 and the maximum inner boundary 903 will be routed. In one embodiment, the result of the route planning is a spiral path. The mapping boundary 901 gradually shrinks in the direction of the maximum inner boundary 903, and the spiral radius gradually decreases, or gradually expands from the maximum inner boundary 903 toward the mapping boundary 901, and the spiral radius gradually becomes larger. This processing method can ensure the maximum Border area processing. The preset boundary processing path is determined according to the cutting width of the mobile device and the processing width of the boundary area processing work. The cutting width is the width of the cutter head, and the processing width of the boundary area processing is the distance between the mapping boundary 901 and the maximum inner boundary 903. In a special case, if the processing width of the boundary area processing work is less than the cutting width, the mobile device performs a circumferential movement around the boundary. But in general, the processing width of the boundary area processing work is larger than the cutting width, so the movement path of the self-mobile device is set to a spiral shape, so from the path, the self-mobile device seems to go around the boundary N circles, but the N The circles are not concentric circles, but continuous spirals.
在另一个实施例中,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。在另一个实施例中,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和。In another embodiment, the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the boundary area processing work ranges from 70 cm to 90 cm from the boundary dividing line to the working area. In another embodiment, the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
S606:控制自移动设备重新获取定位校准点位置的定位用的参考定位信号。S606: Control the mobile device to re-acquire the reference positioning signal for positioning the position of the positioning calibration point.
自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S607:控制自移动设备自定位校准点位置再次向边界方向出发并移动到上一个终止点位置后继续沿边界移动。S607: Control the self-positioning calibration point position of the self-moving device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
上一个终止点位置为自移动设备较近一次停止边界区域处理工作的离开位置,该位置并不一定是位置完全吻合的位置,只要是在上一个终止点位置附近1米的范围内均认 为是上一个终止点位置。The last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
S608:获取自移动设备再次出发后移动过程中的累积误差衡量值,判断累积误差衡量值是否达到设定的累积误差阈值,若是,则控制自移动设备停止边界区域处理工作并执行601,否则,控制自移动设备继续沿边界移动。S608: Acquire the cumulative error measurement value in the moving process after the mobile device starts again, and determine whether the cumulative error measurement value reaches the set cumulative error threshold, and if so, control the mobile device to stop the boundary area processing work and execute 601, otherwise, Control the self-mobile device to continue to move along the boundary.
自移动设备离开定位校准点位置后,会持续记录出发后移动过程中的累积误差衡量值,该累积误差衡量值可以使前述的时间、距离或者位置信息的质量。Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
S609:结束边界区域处理工作任务。S609: End the boundary area processing task.
结束边界区域处理工作任务之后,自移动设备可以回到充电站位置或者定位校准点位置等待下次工作,如果是对工作区域进行了区域划分,形成了多个工作子区域,自移动设备可以继续到其他待工作子区域进行常规的工作。After finishing the work task in the boundary area, the self-mobile device can return to the charging station position or locate the calibration point position and wait for the next work. If the working area is divided into multiple working sub-areas, the self-mobile device can continue Go to other sub-areas to be worked for regular work.
如图14所述,在另一个实施例中,所述预设任务为:自移动设备完成预设的边界处理路径。该边界区域处理路径可以为基于建图边界901及最大内边界903设置的绕边界一周的周向移动路径,为了能够达到更好的边界处理效果,基于建图边界901及最大内边界903之间的距离及切割宽度之间的关系,可以设置多个周向移动路径,该多个周向移动路径可以存在重叠区,当然,最优的方案是移动路径尽量不同,如此设置,可以保证对边界区域的处理效果。As shown in FIG. 14, in another embodiment, the preset task is: completing the preset boundary processing path from the mobile device. The boundary area processing path can be a circumferential movement path around the boundary set based on the mapping boundary 901 and the maximum inner boundary 903. In order to achieve a better boundary processing effect, it is based on the mapping boundary 901 and the maximum inner boundary 903. The relationship between the distance and the cutting width can be set with multiple circumferential moving paths. The multiple circumferential moving paths may have overlapping areas. Of course, the optimal solution is to have different moving paths as much as possible. This setting can ensure that the boundary The treatment effect of the area.
设置多个周向移动路径,即自移动设备在完成预设任务后,继续以相同步骤进行N个周向移动路径的边界处理,N≥1,结合不同的刀盘切割宽度,在一个实施例中,N=4,在另一个实施例中,N=5。N个周向移动路径的所述边界处理相互之间存在处理重叠区。该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点可以方向不同,比如,第一次边界处理时的边界起始点方向与第二次边界处理时的边界起始点方向不同。为了达到更好的边界处理效果,该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点位置至少部分不同,比如,第一次边界处理时的边界起始点位置与第二次边界处理时的边界起始点位置不同,如果假设第一次边界处理形成第一圈,第二次边界处理形成第二圈,认为至少部分同一方向上的点位置不同,即第一圈和第二圈中圈上同一方向的点至定位校准点位置的距离不同。Set multiple circumferential movement paths, that is, after the mobile device completes the preset task, continue to perform boundary processing of N circumferential movement paths in the same step, N≥1, combined with different cutter head cutting widths, in one embodiment In another embodiment, N=4. In another embodiment, N=5. There is a processing overlap area between the boundary processing of the N circumferential movement paths. For the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position point on the boundary, the direction may be different. For example, the direction of the boundary starting point during the first boundary processing is different from the second The direction of the starting point of the boundary is different during boundary processing. In order to achieve a better boundary processing effect, the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing The position of the boundary starting point is different from that of the second boundary processing. If it is assumed that the first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction The position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different.
具体的,所述自移动设备停止边界区域处理工作的步骤之后,还包括步骤S701至步骤S709。Specifically, after the step of stopping the processing of the boundary area from the mobile device, it further includes step S701 to step S709.
S701:判断自移动设备是否存在待工作区域,若是,则执行S702,否则,则执行S704。S701: Determine whether the self-mobile device has an area to work, if yes, execute S702, otherwise, execute S704.
如果存在工作区域,自移动设备可以返回距离最近的工作区域进行工作。If there is a work area, the self-mobile device can return to the nearest work area for work.
S702:控制自移动设备返回待工作区域进行工作。S702: Control the mobile device to return to the waiting area for work.
S703:判断自移动设备是否满足返回定位校准点位置的预设条件,若是,则执行S704,否则,控制自移动设备继续工作。S703: Determine whether the self-mobile device meets the preset condition of returning to the position of the positioning calibration point, if yes, execute S704, otherwise, control the self-mobile device to continue working.
返回定位校准点位置的预设条件为自移动设备完成了所在工作区域的工作或者自移动设备电量不足或者误差评估结果表明定位误差较大需要重新回定位校准点位置重新获取新的定位用的参考定位信号。The preset condition for returning to the position of the positioning calibration point is that the mobile device has completed the work in the working area or the power of the mobile device is insufficient or the error evaluation result indicates that the positioning error is large. It is necessary to reposition the calibration point position to obtain a new positioning reference Positioning signal.
S704:控制自移动设备返回定位校准点。S704: Control the self-mobile device to return to the positioning calibration point.
自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S705:判断自移动设备是否完成N个周向移动路径的边界处理,若是,则执行S709,否则,则执行S706。S705: Determine whether the self-mobile device has completed the boundary processing of the N circumferential movement paths, if yes, execute S709, otherwise, execute S706.
完成的N个周向移动路径的边界处理可以存在处理重叠区。There may be a processing overlap area in the boundary processing of the completed N circumferential movement paths.
S706:控制自移动设备重新获取定位校准点位置的定位用的参考定位信号。S706: Control the mobile device to re-acquire the reference positioning signal for positioning the position of the positioning calibration point.
自移动设备可以根据当前位置返回离当前位置最近的定位校准点位置。The self-mobile device can return to the position of the positioning calibration point closest to the current position according to the current position.
S707:控制自移动设备自定位校准点位置再次向边界方向出发并移动到上一个终止点位置后继续沿边界移动。S707: Control the self-positioning calibration point position of the self-moving device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary.
上一个终止点位置为自移动设备较近一次停止边界区域处理工作的离开位置,该位置并不一定是位置完全吻合的位置,只要是在上一个终止点位置附近1米的范围内均认为是上一个终止点位置。The last end point position is the departure position from the mobile device that stopped the boundary area processing work recently. This position is not necessarily a position that exactly matches the position, as long as it is within 1 meter of the last end point position. The position of the last end point.
S708:获取自移动设备再次出发后移动过程中的累积误差衡量值,判断累积误差衡量值是否达到设定的累积误差阈值,若是,则控制自移动设备停止边界区域处理工作并执行701,否则,控制自移动设备继续沿边界移动。S708: Acquire the cumulative error measurement value in the moving process after the mobile device starts again, and determine whether the cumulative error measurement value reaches the set cumulative error threshold, if so, control the mobile device to stop the boundary area processing work and execute 701, otherwise, Control the self-mobile device to continue to move along the boundary.
自移动设备离开定位校准点位置后,会持续记录出发后移动过程中的累积误差衡量值,该累积误差衡量值可以使前述的时间、距离或者位置信息的质量。Since the mobile device leaves the position of the positioning calibration point, it will continue to record the cumulative error measurement value in the movement process after departure, and the cumulative error measurement value can make the quality of the aforementioned time, distance or location information.
S709:结束边界区域处理工作任务。S709: End the boundary area processing task.
结束边界区域处理工作任务之后,自移动设备可以回到定位校准点位置等待下次工作,如果是对工作区域进行了区域划分,形成了多个工作子区域,自移动设备可以继续到其他待工作子区域进行常规的工作。After finishing the work task in the boundary area, the self-mobile device can return to the position of the positioning calibration point and wait for the next work. If the work area is divided into multiple working sub-areas, the self-mobile device can continue to other waiting work The sub-area performs routine work.
如图14所示,上述N个周向移动路径的边界处理中,以某一个方向为起点,对于同一个方向终点而言,自移动设备尽量位于同一方向上的边界上的不同位置,即自移动设备在不同的周向移动路径的边界处理中在同一方向上位于边界的不同位置上,如此设置,可以保证同一方向上的边界位置可以被最大限度的处理,进而提高整个边界的处理效果。N个周向移动路径的边界处理中,每个周向移动路径的边界处理的位于边界上的起点方向也可以是不同的,即N个边界处理可以具有N个边界起始移动方向及N个边界起始工作位置,不管如何选择,N个边界处理相互之间存在处理重叠区。As shown in Figure 14, in the above-mentioned boundary processing of the N circumferential movement paths, a certain direction is used as the starting point. For the end point in the same direction, the mobile device should be located at different positions on the boundary in the same direction as much as possible, that is, The mobile device is located at different positions of the boundary in the same direction in the boundary processing of different circumferential movement paths. This configuration can ensure that the boundary position in the same direction can be processed to the maximum extent, thereby improving the processing effect of the entire boundary. In the boundary processing of N circumferential movement paths, the starting point direction on the boundary of the boundary processing of each circumferential movement path can also be different, that is, N boundary processing can have N boundary starting movement directions and N Regardless of the selection of the starting working position of the boundary, there is a processing overlap area between the N boundary processings.
图15是本发明实施例的自移动设备的结构示意图。如图15所示,自移动设备还包括:Fig. 15 is a schematic structural diagram of a self-moving device according to an embodiment of the present invention. As shown in Figure 15, the self-mobile device also includes:
边界信息获取模块21,所述控制模块控制自移动设备自定位校准点位置向边界信息获取模块获取的边界方向出发并沿获取的边界移动。The boundary information acquisition module 21, the control module controls the mobile device to move from the position of the calibration point to the boundary acquired by the boundary information acquisition module and move along the acquired boundary.
信号获取模块22,用于获取自移动设备在移动过程中的当前定位信号,以及自移动设备在所述当前定位信号之前的参考定位信号用于当前位置信息确定。The signal acquisition module 22 is configured to acquire the current positioning signal from the mobile device during the movement, and the reference positioning signal from the mobile device before the current positioning signal is used to determine the current position information.
移动信息获取模块23,所述移动信息获取模块23进一步包括包括累积误差衡量值获取模块及定位质量值获取模块。累积误差衡量值获取模块,用于获取累积误差衡量值,所述控制模块控制自移动设备在累积误差衡量值达到设定的累积误差阈值时停止边界区域处理工作。定位质量值获取模块,用于获取定位质量值,所述控制模块控制自移动设备在定位质量值达到设定的定位质量阈值时停止边界区域处理工作。The mobile information acquisition module 23 further includes a cumulative error measurement value acquisition module and a positioning quality value acquisition module. The cumulative error measurement value acquisition module is used to obtain the cumulative error measurement value. The control module controls the mobile device to stop the boundary area processing when the cumulative error measurement value reaches the set cumulative error threshold. The positioning quality value acquisition module is used to acquire the positioning quality value, and the control module controls the mobile device to stop the boundary area processing work when the positioning quality value reaches the set positioning quality threshold.
所述参考定位信号为自移动设备直接从卫星采集获得。The reference positioning signal is directly collected from the mobile device from the satellite.
在一个实施例中,累积误差衡量值获取模块可以用于获取自移动设备移动的时间数据,所述累积误差阈值为时间阈值,所述控制模块判断移动信息获取模块获取的时间值是否达到设定的时间阈值,若时间值达到设定的时间阈值,则控制自移动设备停止边界区域处理工作。In one embodiment, the cumulative error measurement value acquisition module may be used to acquire time data from the movement of the mobile device, the cumulative error threshold is a time threshold, and the control module determines whether the time value acquired by the movement information acquisition module reaches a set value. If the time value reaches the set time threshold value, control the mobile device to stop the processing of the boundary area.
在一个实施例中,累积误差衡量值获取模块用于获取自移动设备移动的距离数据,所述累积误差阈值为距离阈值,所述控制模块判断移动信息获取模块获取的距离值是否达到设定的距离阈值,若距离值达到设定的距离阈值,则控制自移动设备停止边界区域处理工作。In one embodiment, the cumulative error measurement value acquisition module is used to acquire distance data from the movement of the mobile device, the cumulative error threshold is a distance threshold, and the control module determines whether the distance value acquired by the movement information acquisition module reaches a set value. The distance threshold, if the distance value reaches the set distance threshold, the mobile device is controlled to stop the processing of the boundary area.
在一个实施例中,所述自移动设备还包括边界处理判断模块、工作区域判断模块及回归判断模块。所述边界处理判断模块用于判断自移动设备是否完成N个周向移动路径的边界处理,N≥1,并在未完成N个周向移动路径的边界处理时,所述控制模块控制自移动设备从边界离开并返回定位校准点位置重新获取定位用的参考定位信号。当N>2时,自移动设备在完成一个周向移动路径的边界区域处理工作任务后,继续以相同步骤进行N个周向移动路径的边界处理,N≥1,结合不同的刀盘切割宽度,在一个实施例中,N=4,在另一个实施例中,N=5。N个周向移动路径的所述边界处理相互之间存在处理重叠区。该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点可以方向不同,比如,第一次边界处理时的边界起始点方向与第二次边界处理时的边界起始点方向不同。为了达到更好的边界处理效果,该N个周向移动路径的边界处理,每次自移动设备从定位校准点出发到边界上的起始位置点位置至少部分不同,比如,第一次边界处理时的边界起始点位置与第二次边界处理时的边界起始点位置不同,如果假设第一次边界处理形成第一圈,第二次边界处理形成第二圈,认为至少部分同一方向上的点位置不同,即第一圈和第二圈中圈上同一方向的点至定位校准点位置的距离不同In an embodiment, the self-mobile device further includes a boundary processing judgment module, a work area judgment module, and a regression judgment module. The boundary processing judgment module is used to judge whether the self-mobile device has completed the boundary processing of N circumferential movement paths, N≥1, and when the boundary processing of the N circumferential movement paths has not been completed, the control module controls the self-moving The device leaves the boundary and returns to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning. When N>2, after the mobile device completes the task of processing the boundary area of a circumferential movement path, it continues to perform the boundary processing of N circumferential movement paths in the same step, N≥1, combined with different cutting widths of the cutter head In one embodiment, N=4, in another embodiment, N=5. There is a processing overlap area between the boundary processing of the N circumferential movement paths. For the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position point on the boundary, the direction may be different. For example, the direction of the boundary starting point during the first boundary processing is different from the second The direction of the starting point of the boundary is different during boundary processing. In order to achieve a better boundary processing effect, the boundary processing of the N circumferential movement paths, each time the mobile device starts from the positioning calibration point to the starting position on the boundary is at least partially different, for example, the first boundary processing The position of the boundary starting point is different from that of the second boundary processing. If it is assumed that the first boundary processing forms the first circle and the second boundary processing forms the second circle, it is considered that at least part of the points in the same direction The position is different, that is, the distance from the point in the same direction on the first circle and the second circle to the position of the positioning calibration point is different
自移动设备可以预设周向移动路径的个数,当自移动设备获知已经达到预设周向移动路径的个数阈值时,则结束边界区域处理工作任务。所述工作区域判断模块用于判断自移动设备是否存在待工作区域,并在存在待工作区域时,所述控制模块控制自移动设备从边界离开并返回待工作区域进行工作。所述回归判断模块用于判断自移动设备是否满足返回定位校准点位置的预设条件,并在满足返回定位校准点位置的预设条件时,所述控制模块控制自移动设备从工作区域返回定位校准点位置。The number of circumferential movement paths can be preset from the mobile device, and when it is learned from the mobile device that the preset circumferential movement path number threshold has been reached, the boundary area processing task is ended. The working area judgment module is used to judge whether the self-mobile device has a working area, and when there is a working area, the control module controls the self-mobile device to leave the boundary and return to the working area to work. The regression judgment module is used to judge whether the self-mobile device meets the preset condition of returning to the position of the positioning calibration point, and when the preset condition of returning to the position of the positioning calibration point is satisfied, the control module controls the self-mobile device to return to the position from the working area Calibration point location.
在控制自移动设备停止边界区域处理工作的步骤之后,所述自移动设备在控制模块的控制下具有至少两种行为逻辑,该两种行为逻辑均基于边界处理判断模块判断自移动设备还未完成N个周向移动路径的完整的边界处理,两种行为逻辑具体如下。After the step of controlling the self-mobile device to stop the boundary area processing work, the self-mobile device has at least two behavior logics under the control of the control module, and the two behavior logics are based on the boundary processing judgment module to determine that the self-mobile device has not completed For the complete boundary processing of N circumferential movement paths, the two behavior logics are specifically as follows.
第一种行为逻辑:在控制自移动设备停止边界区域处理工作的步骤之后,边界处理判断模块判断自移动设备还未完成N个周向移动路径的完整的边界处理,所述控制模块控制自移动设备返回定位校准点位置重新获取定位用的参考定位信号,然后,所述控制模块控制自移动设备自定位校准点位置再次向边界方向出发并移动到上一个终止点位置后继续沿边界移动,所述控制模块判断移动信息获取模块再次出发后获取的累积误差衡量值是否达到设定的累积误差阈值,若累积误差衡量值达到设定的累积误差阈值,则控制自移动设备再次停止边界区域处理工作,并进行流程循环。The first behavior logic: after the step of controlling the self-mobile device to stop the processing of the boundary area, the boundary processing judgment module judges that the self-mobile device has not completed the complete boundary processing of the N circumferential movement paths, and the control module controls the self-movement The device returns to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning. Then, the control module controls the self-positioning calibration point position of the mobile device to start again in the direction of the boundary and move to the position of the last termination point, and then continue to move along the boundary. The control module determines whether the cumulative error measurement value obtained after the mobile information acquisition module starts again reaches the set cumulative error threshold, and if the cumulative error measurement reaches the set cumulative error threshold, it controls the mobile device to stop the boundary area processing work again , And carry out the process cycle.
第二种行为逻辑:在控制自移动设备停止边界区域处理工作的步骤之后,所述工作区域判断模块判断自移动设备存在待工作区域,所述控制模块控制自移动设备返回待工作区域进行工作,所述控制模块判断自移动设备是否满足返回定位校准点位置的预设条件,若满足预设条件,所述控制模块控制自移动设备返回定位校准点位置重新获取定位用的参考定位信号,边界处理判断模块判断自移动设备还未完成N个周向移动路径的完整的边界处理,所述控制模块控制自移动设备自定位校准点位置再次向边界方向出发并 移动到上一个终止点位置后继续沿边界移动,所述控制模块判断移动信息获取模块再次出发后获取的累积误差衡量值是否达到设定的累积误差阈值,若累积误差衡量值达到设定的累积误差阈值,则控制自移动设备停止边界区域处理工作,并进行流程循环。The second kind of behavior logic: after the step of controlling the self-mobile device to stop the boundary area processing work, the working area judgment module judges that the self-mobile device has an area to be worked, and the control module controls the self-mobile device to return to the working area for work, The control module determines whether the mobile device meets the preset condition for returning to the position of the positioning calibration point. If the preset condition is satisfied, the control module controls the mobile device to return to the position of the positioning calibration point to re-acquire the reference positioning signal for positioning, and boundary processing The judging module judges that the mobile device has not completed the complete boundary processing of the N circumferential movement paths, and the control module controls the self-positioning calibration point position of the self-mobile device to start again in the boundary direction and move to the last termination point position and continue along Border movement, the control module judges whether the cumulative error measurement value obtained after the movement information acquisition module starts again reaches the set cumulative error threshold, and if the cumulative error measurement value reaches the set cumulative error threshold, control the mobile device to stop the boundary Area processing work, and the process cycle.
如图16所示,为了能够利用参考定位信号对自移动设备进行定位,自移动设备除了包括信号获取模块22,自移动设备还包括:As shown in FIG. 16, in order to be able to use the reference positioning signal to locate the self-mobile device, in addition to the signal acquisition module 22, the self-mobile device also includes:
解算处理模块24,用于对所述参考定位信号和所述当前定位信号进行解算处理获得误差数据,进行解算处理的所述参考定位信号和所述当前定位信号存在共用卫星信号。The solution processing module 24 is configured to perform solution processing on the reference positioning signal and the current positioning signal to obtain error data, and the reference positioning signal subjected to the solution processing and the current positioning signal have a common satellite signal.
位置确定模块25,用于根据所述误差数据及所述参考定位信号的位置信息确定自移动设备的当前位置信息。The position determining module 25 is configured to determine the current position information of the mobile device according to the error data and the position information of the reference positioning signal.
所述自移动设备还包括:定位校准点位置确定模块,用于确定定位校准点位置的参考坐标,所述信号获取模块22获取自移动设备在定位校准点位置的定位信号,将该定位信号作为首个参考定位信号。所述定位校准点位置为充电站位置或者自移动设备的工作区域内设定的具有固定的参考坐标的定位校准点。The self-mobile device further includes: a positioning calibration point position determination module for determining the reference coordinates of the positioning calibration point position, the signal acquisition module 22 acquires the positioning signal from the mobile device at the positioning calibration point position, and uses the positioning signal as The first reference positioning signal. The position of the positioning calibration point is the position of the charging station or the positioning calibration point with fixed reference coordinates set in the working area of the mobile device.
所述自移动设备包括:解算条件判断模块,所述解算条件判断模块用于:判断选择的参考定位信号是否满足解算条件;若选择的参考定位信号满足解算条件,则将该参考定位信号作为后续解算处理的参考定位信号;若选择的参考定位信号不满足解算条件,则选择再前最近时刻的卫星信号作为参考定位信号并重复判断选择的参考定位信号是否满足解算条件,重复本步骤直至获得符合解算条件的参考定位信号。所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,进一步的,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,且卫星信号的信号质量达到设定的信号噪声比阈值。The self-mobile device includes: a solution condition determination module, the solution condition determination module is used to determine whether the selected reference positioning signal satisfies the solution condition; if the selected reference positioning signal meets the solution condition, the reference The positioning signal is used as the reference positioning signal for the subsequent calculation processing; if the selected reference positioning signal does not meet the calculation conditions, the satellite signal at the nearest time is selected as the reference positioning signal and repeatedly judge whether the selected reference positioning signal meets the calculation conditions , Repeat this step until the reference positioning signal that meets the calculation conditions is obtained. The solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and further, the solution condition is: the number of shared satellites reaches the set threshold for the number of resolved satellites, and the signal quality of the satellite signal reaches Set the signal-to-noise ratio threshold.
从上述可知,进行解算处理的所述参考定位信号和所述当前定位信号存在共用卫星信号。当共用卫星数量达到设定的解算卫星数阈值时,所述参考定位信号和所述当前定位信号进行解算处理。It can be known from the foregoing that the reference positioning signal and the current positioning signal that are subjected to the solution processing have a common satellite signal. When the number of shared satellites reaches the set threshold for the number of resolved satellites, the reference positioning signal and the current positioning signal are resolved.
所述自移动设备还包括误差评估模块,所述误差评估模块用于:对处理获得的自移动设备的当前位置信息进行误差评估;和当误差评估结果满足误差条件时,自移动设备返回定位校准点重新获取初始的参考定位信号。所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。所述误差条件为:自移动设备的工作时间达到设定的总工作时间阈值。所述误差条件还可以为:选择的参考定位信号不满足解算条件。其中,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,进一步的,所述解算条件为:共用卫星数量达到设定的解算卫星数阈值,且卫星信号的信号质量达到设定的信号噪声比阈值。The self-mobile device further includes an error evaluation module configured to: perform error evaluation on the current position information of the self-mobile device obtained by processing; and when the error evaluation result meets the error condition, return to the positioning calibration from the mobile device Click to reacquire the initial reference positioning signal. The position of the positioning calibration point is the position of the charging station or the position with fixed coordinates set in the working area. The error condition is: the working time of the mobile device reaches the set total working time threshold. The error condition may also be: the selected reference positioning signal does not satisfy the solution condition. Wherein, the solution condition is: the number of shared satellites reaches the set threshold of the number of resolved satellites, and further, the solution condition is: the number of shared satellites reaches the set threshold of the number of resolved satellites, and the signal of the satellite signal The quality reaches the set signal-to-noise ratio threshold.
自移动设备的工作区域内设置有多个定位校准点,多个所述定位校准点相互之间具有已知的固定的参考坐标,当自移动设备移动到定位校准点位置时,所述自移动设备将定位校准点的位置信息作为当前位置信息。A plurality of positioning calibration points are arranged in the working area of the self-mobile device, and the plurality of positioning calibration points have known fixed reference coordinates among each other. When the self-mobile device moves to the position of the positioning calibration point, the self-moving The device uses the position information of the positioning calibration point as the current position information.
自移动设备返回定位校准点重新获取初始的参考定位信号时,清除自移动设备保存的所有非当前定位信号。When returning to the positioning calibration point from the mobile device to re-acquire the initial reference positioning signal, all non-current positioning signals saved from the mobile device are cleared.
所述自移动设备还包括:The self-moving device further includes:
信号强度判定模块,用于确定所述卫星信号的信号强度是否小于预定阈值;和A signal strength determination module for determining whether the signal strength of the satellite signal is less than a predetermined threshold; and
所述位置确定模块用于响应于所述卫星信号的信号强度小于预定阈值,结合定位传感器确定所述自移动设备的位置信息。所述定位传感器包括惯性导航装置、或激光雷达、 或无载波通信装置。The position determining module is configured to determine the position information of the self-mobile device in combination with a positioning sensor in response to the signal strength of the satellite signal being less than a predetermined threshold. The positioning sensor includes an inertial navigation device, or a lidar, or a carrierless communication device.
计算机可读存储介质,其上存储有计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行本说明书上述自移动设备的控制方法中的步骤。A computer-readable storage medium has computer program instructions stored thereon, and when the computer program instructions are executed by a processor, the processor executes the steps in the method for controlling a mobile device described above in this specification.
所述计算机可读存储介质可以采用一个或多个可读介质的任意组合。可读介质可以是可读信号介质或者可读存储介质。可读存储介质例如可以包括但不限于电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。可读存储介质的更具体的例子(非穷举的列表)包括:具有一个或多个导线的电连接、便携式盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。The computer-readable storage medium may adopt any combination of one or more readable media. The readable medium may be a readable signal medium or a readable storage medium. The readable storage medium may include, but is not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or a combination of any of the above, for example. More specific examples (non-exhaustive list) of readable storage media include: electrical connections with one or more wires, portable disks, hard disks, random access memory (RAM), read-only memory (ROM), erasable Type programmable read only memory (EPROM or flash memory), optical fiber, portable compact disk read only memory (CD-ROM), optical storage device, magnetic storage device, or any suitable combination of the above.
为了实现上述实施例,本发明还提出一种计算机程序产品,当所述计算机程序产品中的指令由处理器执行时,执行一种自移动设备的控制方法,所述方法包括:In order to implement the above-mentioned embodiments, the present invention also provides a computer program product. When instructions in the computer program product are executed by a processor, a method for controlling a mobile device is executed, the method comprising:
获取工作区域的边界信息;Obtain the boundary information of the working area;
控制自移动设备自定位校准点位置向边界方向出发并沿边界移动;Control the self-positioning calibration point position of the mobile device to start in the direction of the boundary and move along the boundary;
获取自移动设备在移动过程中的当前定位信号,自移动设备在所述当前定位信号之前的参考定位信号以及所述参考定位信号的位置信息用于当前位置信息确定;The current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information;
获取自移动设备在移动过程中的累积误差衡量值,当累积误差衡量值达到设定的累积误差阈值时,控制自移动设备停止边界区域处理工作。The cumulative error measurement value obtained from the mobile device in the moving process, when the cumulative error measurement value reaches the set cumulative error threshold, the mobile device is controlled to stop the boundary area processing work.
计算机程序产品,其包括计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行本说明书上述“自移动设备的控制方法”中的步骤。A computer program product includes computer program instructions that, when run by a processor, cause the processor to execute the steps in the "method for controlling a self-mobile device" mentioned in this specification.
所述计算机程序产品可以以一种或多种程序设计语言的任意组合来编写用于执行本申请实施例操作的程序代码,所述程序设计语言包括面向对象的程序设计语言,诸如Java、C++等,还包括常规的过程式程序设计语言,诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算设备上执行、部分地在用户设备上执行、作为一个独立的软件包执行、部分在用户计算设备上部分在远程计算设备上执行、或者完全在远程计算设备或服务器上执行。The computer program product may use any combination of one or more programming languages to write program codes for performing the operations of the embodiments of the present application. The programming languages include object-oriented programming languages, such as Java, C++, etc. , Also includes conventional procedural programming languages, such as "C" language or similar programming languages. The program code can be executed entirely on the user's computing device, partly on the user's device, executed as an independent software package, partly on the user's computing device and partly executed on the remote computing device, or entirely on the remote computing device or server Executed on.
为了实现上述实施例,本发明还提出一种电子设备,其包括:In order to implement the foregoing embodiments, the present invention also provides an electronic device, which includes:
存储器,用于存储计算机可执行指令;和Memory for storing computer executable instructions; and
处理器,用于执行所述存储器存储的计算机可执行指令,以执行一种自移动设备的控制方法,所述方法包括:The processor is configured to execute computer-executable instructions stored in the memory to execute a method for controlling a mobile device, the method comprising:
获取工作区域的边界信息;Obtain the boundary information of the working area;
控制自移动设备自定位校准点位置向边界方向出发并沿边界移动;Control the self-positioning calibration point position of the mobile device to start in the direction of the boundary and move along the boundary;
获取自移动设备在移动过程中的当前定位信号,自移动设备在所述当前定位信号之前的参考定位信号以及所述参考定位信号的位置信息用于当前位置信息确定;The current positioning signal obtained from the mobile device during the movement, the reference positioning signal from the mobile device before the current positioning signal, and the position information of the reference positioning signal are used to determine the current position information;
获取自移动设备在移动过程中的累积误差衡量值,当累积误差衡量值达到设定的累积误差阈值时,控制自移动设备停止边界区域处理工作。The cumulative error measurement value obtained from the mobile device in the moving process, when the cumulative error measurement value reaches the set cumulative error threshold, the mobile device is controlled to stop the boundary area processing work.
该电子设备可以是在自移动设备的移动站中集成的电子设备,或者与该移动站独立的单机设备,该单机设备可以与移动站进行通信,以实现根据本发明一实施例的自移动设备的控制方法。The electronic device may be an electronic device integrated in a mobile station of a self-mobile device, or a stand-alone device independent of the mobile station, and the stand-alone device can communicate with the mobile station to realize the self-mobile device according to an embodiment of the present invention的控制方法。 Control methods.
图17为本发明一实施例的电子设备的示意性框图。FIG. 17 is a schematic block diagram of an electronic device according to an embodiment of the present invention.
如图17所示,电子设备600包括一个或多个处理器610和存储器620。As shown in FIG. 17, the electronic device 600 includes one or more processors 610 and a memory 620.
处理器610可以是中央处理单元(CPU)或者具有数据处理能力和/或指令执行能力的其他形式的处理单元,并且可以控制电子设备600中的其他组件以执行期望的功能。The processor 610 may be a central processing unit (CPU) or other form of processing unit with data processing capability and/or instruction execution capability, and may control other components in the electronic device 600 to perform desired functions.
存储器620可以包括一个或多个计算机程序产品,所述计算机程序产品可以包括各种形式的计算机可读存储介质,例如易失性存储器和/或非易失性存储器。所述易失性存储器例如可以包括随机存取存储器(RAM)和/或高速缓冲存储器(cache)等。所述非易失性存储器例如可以包括只读存储器(ROM)、硬盘、闪存等。在所述计算机可读存储介质上可以存储一个或多个计算机程序指令,处理器610可以运行所述程序指令,以实现上文所述的本发明的各个实施例的自移动设备的定位故障报警方法以及/或者其他期望的功能。在所述计算机可读存储介质中还可以存储诸如天线的位置数据、天线相对于自移动设备的安装位置等各种内容。The memory 620 may include one or more computer program products, and the computer program products may include various forms of computer-readable storage media, such as volatile memory and/or non-volatile memory. The volatile memory may include random access memory (RAM) and/or cache memory (cache), for example. The non-volatile memory may include, for example, read-only memory (ROM), hard disk, flash memory, and the like. One or more computer program instructions may be stored on the computer-readable storage medium, and the processor 610 may run the program instructions to implement the positioning fault alarm of the mobile device according to the various embodiments of the present invention described above. Methods and/or other desired functions. The computer-readable storage medium may also store various contents such as the position data of the antenna, the installation position of the antenna relative to the mobile device, and the like.
在一个示例中,电子设备600还可以包括:输入装置630和输出装置640,这些组件通过总线系统和/或其他形式的连接机构(未示出)互连。In an example, the electronic device 600 may further include: an input device 630 and an output device 640, and these components are interconnected by a bus system and/or other forms of connection mechanisms (not shown).
例如,该输入装置630可以是用于接收用户输入。For example, the input device 630 may be used to receive user input.
该输出装置640可以直接向外部输出各种信息,或者控制移动站发送信号。The output device 640 can directly output various information to the outside, or control the mobile station to send signals.
当然,为了简化,图17中仅示出了该电子设备600中与本申请有关的组件中的一些,省略了诸如总线、输入/输出接口等等的组件。除此之外,根据具体应用情况,电子设备600还可以包括任何其他适当的组件。Of course, for simplification, only some of the components related to the present application in the electronic device 600 are shown in FIG. 17, and components such as buses, input/output interfaces, etc. are omitted. In addition, the electronic device 600 may also include any other appropriate components according to specific application conditions.
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。It should be understood that each part of the present invention can be implemented by hardware, software, firmware or a combination thereof. In the above embodiments, multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if it is implemented by hardware, as in another embodiment, it can be implemented by any one or a combination of the following technologies known in the art: Discrete logic circuits, application-specific integrated circuits with suitable combinational logic gates, programmable gate arrays (PGA), field programmable gate arrays (FPGA), etc.
此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。In addition, the functional units in the various embodiments of the present invention may be integrated into one processing module, or each unit may exist alone physically, or two or more units may be integrated into one module. The above-mentioned integrated modules can be implemented in the form of hardware or software function modules. If the integrated module is implemented in the form of a software function module and sold or used as an independent product, it can also be stored in a computer readable storage medium.
尽管本说明书中仅描述和图示了本发明的几个实施例,但是本领域技术人员应该容易预见用于执行这里描述的功能/或者获得这里描述的结构的其它手段或结构,每个这样的变化或者修改都视为在本发明的范围内。Although only a few embodiments of the present invention are described and illustrated in this specification, those skilled in the art should easily foresee other means or structures for performing the functions described herein/or obtaining the structures described herein, each such Changes or modifications are deemed to be within the scope of the present invention.

Claims (25)

  1. 一种自移动设备的控制方法,其特征在于,包括步骤:A method for controlling a self-mobile device, which is characterized in that it comprises the steps:
    S101:获取工作区域地图上的边界信息;S101: Obtain boundary information on the work area map;
    S102:控制具有累积定位误差的自移动设备在一定位校准点完成位置校准后在边界上移动,并进行边界区域处理工作;S102: Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
    S103:获取自移动设备离开定位校准点后的累积误差衡量值或定位质量值,当累积误差衡量值达到设定的累积误差阈值时或定位质量值达到设定的定位质量阈值时,控制自移动设备停止边界区域处理工作,其中,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值,其中,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置;S103: Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point, and control the self-movement when the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold The device stops processing the boundary area, wherein the cumulative error measurement value is the value of the time since the mobile device left the positioning calibration point, or the value of the movement distance since the mobile device left the positioning calibration point, wherein the position of the positioning calibration point It is the position of the charging station or the position with fixed coordinates set in the working area;
    在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤:After the step of controlling the mobile device to stop the processing of the boundary area, the method further includes the following steps:
    判断自移动设备是否完成预设的边界处理路径,若是,则结束边界区域处理工作,否则,重复步骤S102至S103,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离,或,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和;Determine whether the mobile device has completed the preset boundary processing path. If yes, end the boundary area processing work; otherwise, repeat steps S102 to S103. The length of the preset boundary processing path is proportional to the processing width of the boundary area processing work. , The boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing work is the distance between the mapping boundary and the maximum inner boundary, or the boundary information includes distinguishing the working area and the maximum inner boundary. The boundary line of the non-working area, the processing width range of the boundary area processing work is 70cm-90cm from the boundary line to the working area, and the processing width of the boundary area processing work is the set safety distance and setting The sum of cumulative error thresholds;
    在重复步骤S102至S103之前,还包括:Before repeating steps S102 to S103, it also includes:
    S301:判断自移动设备是否存在待工作区域,若是,则执行S302至S304,否则,重复步骤S102至S103;S301: Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
    S302:控制自移动设备返回待工作区域进行工作;S302: Control the mobile device to return to the waiting area for work;
    S303:判断自移动设备是否满足返回一定位校准点位置的预设条件,若是,则执行S304,否则,控制自移动设备继续工作;S303: Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
    S304:控制自移动设备返回一定位校准点。S304: Control the mobile device to return to a positioning calibration point.
  2. 一种自移动设备的控制方法,其特征在于,包括步骤:A method for controlling a self-mobile device, which is characterized in that it comprises the steps:
    S101:获取工作区域地图上的边界信息;S101: Obtain boundary information on the work area map;
    S102:控制具有累积定位误差的自移动设备在一定位校准点完成位置校准后在边界上移动,并进行边界区域处理工作;S102: Control the self-moving device with accumulated positioning error to move on the boundary after completing position calibration at a positioning calibration point, and perform boundary area processing work;
    S103:获取自移动设备离开定位校准点后的累积误差衡量值或定位质量值,当累积误差衡量值达到设定的累积误差阈值时或定位质量值达到设定的定位质量阈值时,控制自移动设备停止边界区域处理工作。S103: Obtain the cumulative error measurement value or the positioning quality value after the mobile device leaves the positioning calibration point, and control the self-movement when the cumulative error measurement value reaches the set cumulative error threshold or the positioning quality value reaches the set positioning quality threshold The equipment stops processing the boundary area.
  3. 根据权利要求2所述的自移动设备的控制方法,其特征在于,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值。The method for controlling a self-mobile device according to claim 2, wherein the cumulative error measurement value is a time value since the mobile device leaves the positioning calibration point, or a moving distance value since the mobile device leaves the positioning calibration point .
  4. 根据权利要求2所述的自移动设备的控制方法,其特征在于,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。The control method of a self-moving device according to claim 2, wherein the position of the positioning calibration point is a charging station position or a position with fixed coordinates set in a working area.
  5. 根据权利要求2所述的自移动设备的控制方法,其特征在于,在控制自移动设备停止边界区域处理工作的步骤之后,还包括步骤:The method for controlling a self-mobile device according to claim 2, wherein after the step of controlling the self-mobile device to stop the processing of the boundary area, the method further comprises the step of:
    判断自移动设备是否完成预设任务,若是,则结束边界区域处理工作,否则,重复 步骤S102至S103。It is judged whether the mobile device has completed the preset task, if so, the boundary area processing work is ended; otherwise, steps S102 to S103 are repeated.
  6. 根据权利要求5所述的自移动设备的控制方法,其特征在于,所述预设任务为:自移动设备完成预设的边界处理路径。The method for controlling a self-mobile device according to claim 5, wherein the preset task is: completing a preset boundary processing path by the mobile device.
  7. 根据权利要求6所述的自移动设备的控制方法,其特征在于,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比。The control method of the self-mobile device according to claim 6, wherein the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
  8. 根据权利要求7所述的自移动设备的控制方法,其特征在于,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离。The control method of the self-mobile device according to claim 7, wherein the boundary information includes a mapping boundary and a maximum inner boundary, and the processing width range of the boundary region processing work is the mapping boundary and the maximum inner boundary. The distance between the borders.
  9. 根据权利要求7所述的自移动设备的控制方法,其特征在于,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。The control method of a self-mobile device according to claim 7, wherein the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width range of the processing work of the boundary area is a self-bounding dividing line Facing 70cm-90cm in the working area.
  10. 根据权利要求7所述的自移动设备的控制方法,其特征在于,所述边界区域处理工作的处理宽度为设定的安全距离与设定的累积误差阈值之和。7. The control method of a self-mobile device according to claim 7, wherein the processing width of the boundary area processing task is the sum of the set safety distance and the set cumulative error threshold.
  11. 根据权利要求5所述的自移动设备的控制方法,其特征在于,在重复步骤S102至S103之前,还包括:The method for controlling a self-mobile device according to claim 5, characterized in that, before repeating steps S102 to S103, the method further comprises:
    S301:判断自移动设备是否存在待工作区域,若是,则执行S302至S304,否则,重复步骤S102至S103;S301: Determine whether there is a waiting area in the mobile device, if yes, perform S302 to S304, otherwise, repeat steps S102 to S103;
    S302:控制自移动设备返回待工作区域进行工作;S302: Control the mobile device to return to the waiting area for work;
    S303:判断自移动设备是否满足返回一定位校准点位置的预设条件,若是,则执行S304,否则,控制自移动设备继续工作;S303: Determine whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point position, if so, execute S304, otherwise, control the self-mobile device to continue working;
    S304:控制自移动设备返回一定位校准点。S304: Control the mobile device to return to a positioning calibration point.
  12. 一种自移动设备,其包括:A self-moving device, which includes:
    壳体;case;
    移动模块,用于带动所述壳体移动;The moving module is used to drive the housing to move;
    任务执行模块,用于执行工作任务;Task execution module, used to perform work tasks;
    控制模块,所述控制模块与移动模块、任务执行模块电连接,控制移动模块带动自移动设备移动,并控制任务执行模块执行工作任务;A control module, which is electrically connected to the mobile module and the task execution module, controls the mobile module to drive the mobile device to move, and controls the task execution module to perform work tasks;
    其特征在于,所述自移动设备还包括:It is characterized in that, the self-moving device further includes:
    边界信息获取模块,用于获取边界信息,所述控制模块控制自移动设备在一定位校准点完成校准后离开定位校准点后在边界上移动,并进行边界区域处理工作;A boundary information acquisition module for acquiring boundary information, the control module controls the mobile device to move on the boundary after leaving the positioning calibration point after completing calibration at a positioning calibration point, and processing the boundary area;
    累积误差衡量值获取模块,用于获取累积误差衡量值,所述控制模块控制自移动设备在累积误差衡量值达到设定的累积误差阈值时停止边界区域处理工作;A cumulative error measurement value acquisition module, configured to obtain a cumulative error measurement value, and the control module controls the mobile device to stop the boundary area processing work when the cumulative error measurement value reaches a set cumulative error threshold;
    定位质量值获取模块,用于获取定位质量值,所述控制模块控制自移动设备在定位质量值达到设定的定位质量阈值时停止边界区域处理工作。The positioning quality value acquisition module is used to acquire the positioning quality value, and the control module controls the mobile device to stop the boundary area processing work when the positioning quality value reaches the set positioning quality threshold.
  13. 根据权利要求12所述的自移动设备,其特征在于,所述累积误差衡量值为自移动设备离开定位校准点后的时间值,或者自移动设备离开定位校准点后的移动距离值。The self-moving device according to claim 12, wherein the cumulative error measurement value is a time value since the mobile device leaves the positioning calibration point, or a moving distance value since the mobile device leaves the positioning calibration point.
  14. 根据权利要求12所述的自移动设备,其特征在于,所述定位校准点位置为充电站位置或者工作区域内设定的具有固定坐标的位置。The self-moving device according to claim 12, wherein the position of the positioning calibration point is a position of a charging station or a position with fixed coordinates set in a working area.
  15. 根据权利要求12所述的自移动设备,其特征在于,所述自移动设备包括:The self-moving device according to claim 12, wherein the self-moving device comprises:
    边界处理判断模块,用于判断自移动设备是否完成预设任务。The boundary processing judgment module is used to judge whether the self-mobile device has completed the preset task.
  16. 根据权利要求15所述的自移动设备,其特征在于,所述预设任务为:自移动设备完成预设的边界处理路径。The self-moving device according to claim 15, wherein the preset task is: completing a preset boundary processing path from the mobile device.
  17. 根据权利要求16所述的自移动设备,其特征在于,所述预设的边界处理路径的长度与边界区域处理工作的处理宽度成正比。The self-moving device according to claim 16, wherein the length of the preset boundary processing path is proportional to the processing width of the boundary area processing work.
  18. 根据权利要求17所述的自移动设备,其特征在于,所述边界信息包括建图边界及最大内边界,所述边界区域处理工作的处理宽度范围为所述建图边界与最大内边界之间的距离。The self-mobile device according to claim 17, wherein the boundary information includes a mapping boundary and a maximum inner boundary, and the processing width of the boundary region processing work is between the mapping boundary and the maximum inner boundary the distance.
  19. 根据权利要求17所述的自移动设备,其特征在于,所述边界信息包括区分工作区域与非工作区域的边界分界线,所述边界区域处理工作的处理宽度范围为自边界分界线朝向工作区域内的70cm-90cm。The self-moving device according to claim 17, wherein the boundary information includes a boundary dividing line that distinguishes a working area from a non-working area, and the processing width of the processing work of the boundary area is from the boundary dividing line to the working area 70cm-90cm inside.
  20. 根据权利要求17所述的自移动设备,其特征在于,所述边界区域处理工作的处理宽度为设定的安全距离与设定的自移动设备的累积误差阈值之和。The self-moving device according to claim 17, wherein the processing width of the boundary area processing task is the sum of a set safety distance and a set cumulative error threshold of the self-moving device.
  21. 根据权利要求12所述的自移动设备,其特征在于,所述自移动设备包括:The self-moving device according to claim 12, wherein the self-moving device comprises:
    工作区域判断模块,用于判断自移动设备是否存在待工作区域,并在存在待工作区域时,所述控制模块控制自移动设备停止边界区域处理工作后返回待工作区域进行工作;The working area judging module is used to judge whether the self-mobile device has a working area, and when there is a working area, the control module controls the self-mobile device to stop the boundary area processing work and then return to the working area to work;
    回归判断模块,用于判断自移动设备是否满足返回一定位校准点的预设条件,并在满足返回一定位校准点的预设条件时,所述控制模块控制自移动设备从工作区域返回一定位校准点。The regression judgment module is used to judge whether the self-mobile device satisfies the preset condition of returning to a positioning calibration point, and when the preset condition of returning to a positioning calibration point is satisfied, the control module controls the self-mobile device to return to a positioning from the working area Calibration point.
  22. 一种自动工作系统,其特征在于,包括:An automatic working system, characterized in that it comprises:
    如权利要求12到21中任意一项所述的自移动设备,在限定的工作区域内移动和工作。The self-moving device according to any one of claims 12 to 21, which moves and works within a limited working area.
  23. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,当所述计算机程序指令被计算装置执行时,可操作来执行如权利要求1到11中任意一项所述的自移动设备的控制方法。A computer-readable storage medium with a computer program stored thereon, characterized in that, when the computer program instructions are executed by a computing device, they are operable to execute the self-moving device according to any one of claims 1 to 11 The control method of the equipment.
  24. 一种计算机程序产品,其特征在于,当所述计算机程序产品中的指令由处理器执行时,执行如权利要求1到11中任意一项所述的自移动设备的控制方法。A computer program product, characterized in that, when the instructions in the computer program product are executed by a processor, the method for controlling a self-mobile device according to any one of claims 1 to 11 is executed.
  25. 一种电子设备,其特征在于,包括:An electronic device, characterized in that it comprises:
    存储器,用于存储计算机可执行指令;和Memory for storing computer executable instructions; and
    处理器,用于执行所述存储器存储的计算机可执行指令,以执行如权利要求1到11中任意一项所述的自移动设备的控制方法。The processor is configured to execute computer-executable instructions stored in the memory to execute the method for controlling a self-mobile device according to any one of claims 1 to 11.
PCT/CN2020/118898 2019-09-29 2020-09-29 Self-moving device and control method therefor, and automatic working system WO2021058030A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910930499.9A CN112578780A (en) 2019-09-29 2019-09-29 Self-moving equipment, control method thereof and automatic working system
CN201910930499.9 2019-09-29

Publications (1)

Publication Number Publication Date
WO2021058030A1 true WO2021058030A1 (en) 2021-04-01

Family

ID=75110375

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/118898 WO2021058030A1 (en) 2019-09-29 2020-09-29 Self-moving device and control method therefor, and automatic working system

Country Status (2)

Country Link
CN (1) CN112578780A (en)
WO (1) WO2021058030A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4270137A1 (en) * 2022-04-28 2023-11-01 Techtronic Cordless GP Creation of a virtual boundary for a robotic garden tool

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116917826A (en) * 2021-06-30 2023-10-20 苏州宝时得电动工具有限公司 automatic working system
CN115016498B (en) 2022-07-05 2023-07-11 未岚大陆(北京)科技有限公司 Mower, and image building method and device thereof as well as storage medium

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007175286A (en) * 2005-12-28 2007-07-12 Funai Electric Co Ltd Automatic cleaning system
CN203609373U (en) * 2013-11-20 2014-05-28 苏州科沃斯商用机器人有限公司 Self-moving robot with correcting device
CN107239074A (en) * 2016-03-29 2017-10-10 苏州宝时得电动工具有限公司 Automatic working system and its map method for building up of working region
CN108398944A (en) * 2016-12-15 2018-08-14 苏州宝时得电动工具有限公司 From the operational method of mobile device, from mobile device, memory and server
EP3491906A1 (en) * 2017-11-30 2019-06-05 LG Electronics Inc. Mobile robot and method of controlling the same

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107544484A (en) * 2016-06-23 2018-01-05 广州零号软件科技有限公司 A kind of method on magnetic stripe setting robot movable border of being navigated by bipolarity
CN107608341A (en) * 2016-07-11 2018-01-19 苏州宝时得电动工具有限公司 Automatic working system and the rehabilitation control method from mobile gardening equipment
CN108803586B (en) * 2017-04-26 2021-08-24 松下家电(中国)有限公司 Working method of sweeping robot
CN109313253A (en) * 2017-05-26 2019-02-05 苏州宝时得电动工具有限公司 Mobile object and its localization method, automatic working system, storage medium
CN109557919B (en) * 2018-12-17 2020-08-14 盐城工学院 Variable-width grid map construction method fusing artificial road sign information

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007175286A (en) * 2005-12-28 2007-07-12 Funai Electric Co Ltd Automatic cleaning system
CN203609373U (en) * 2013-11-20 2014-05-28 苏州科沃斯商用机器人有限公司 Self-moving robot with correcting device
CN107239074A (en) * 2016-03-29 2017-10-10 苏州宝时得电动工具有限公司 Automatic working system and its map method for building up of working region
CN108398944A (en) * 2016-12-15 2018-08-14 苏州宝时得电动工具有限公司 From the operational method of mobile device, from mobile device, memory and server
EP3491906A1 (en) * 2017-11-30 2019-06-05 LG Electronics Inc. Mobile robot and method of controlling the same

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4270137A1 (en) * 2022-04-28 2023-11-01 Techtronic Cordless GP Creation of a virtual boundary for a robotic garden tool

Also Published As

Publication number Publication date
CN112578780A (en) 2021-03-30

Similar Documents

Publication Publication Date Title
WO2018214977A1 (en) Moving object and positioning method therefor, automated working system, and storage medium
WO2021058030A1 (en) Self-moving device and control method therefor, and automatic working system
WO2021058032A1 (en) Map building method, self-moving device, and automatic working system
US20220075376A1 (en) Returning method of self-moving device, self-moving device, storage medium, and server
CN108226965B (en) Positioning fault processing method and device of self-moving equipment and electronic equipment
US11076529B2 (en) Intelligent mowing system
US11272823B2 (en) Zone cleaning apparatus and method
US20190061157A1 (en) Robotic virtual boundaries
CN113296495B (en) Path forming method and device of self-mobile equipment and automatic working system
US20230015335A1 (en) Working map construction method and apparatus, robot, and storage medium
WO2022001929A1 (en) Autonomous mobile apparatus and operating method therefor
WO2021047602A1 (en) Self-moving device and automatic operating system thereof
WO2023104087A1 (en) Automatic operating system, automatic operating method and computer-readable storage medium
WO2022001930A1 (en) Self-moving apparatus and working method therefor
US20230115421A1 (en) Self-moving device and working method therefor
CN117128975B (en) Navigation method, system, medium and equipment for switch cabinet inspection operation robot
WO2022088313A1 (en) Method and system for robot automatic charging, robot, and storage medium
CA3194391A1 (en) Method for determining information, remote terminal, and mower

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20870406

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20870406

Country of ref document: EP

Kind code of ref document: A1