Automatic walking device and boundary signal detection method thereof
By employing a boundary detection module with multi-level amplification and interference threshold processing in the lawnmower robot, the problem of false detection when the lawnmower robot approaches the boundary cable is solved, achieving higher accuracy in boundary signal detection and better anti-interference capability.
Patent Information
- Application Number
- CN202011380633.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-11-30
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2040-11-30
AI Technical Summary
When existing lawnmowers approach boundary cables, ground-reflected interference signals are amplified by a high-magnification amplifier, causing them to be misinterpreted as boundary signals, resulting in false detections.
Two boundary detection modules are used: a first boundary detection module with a fixed first amplification factor and a second boundary detection module with cyclically switching first and second amplification factors. Combined with multi-level interference threshold processing, signal interference is removed by reducing the interference threshold to avoid false detection.
It improves the accuracy of boundary signal detection, enhances anti-interference capabilities, and reduces false detections.
Smart Images

Figure CN114637281B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of automation control technology, and in particular to an automatic walking device and a boundary signal detection method thereof. Background Art
[0002] With the continuous development of science and technology, intelligent walking devices such as sweeping robots and lawn mowers are becoming well-known to people. These intelligent walking devices greatly save people's time and bring convenience to people's work and life. Taking the lawn mower robot as an example, the general working principle is: a pulse current is sent to the boundary cable that encloses the working area through the charging device to generate a magnetic field boundary signal. The lawn mower robot continuously detects the magnetic field signal in the working space and analyzes the boundary information through the signal characteristic value, thereby determining the position of the lawn mower robot. However, due to the presence of many interference signals in the environment and the weak boundary signal, the boundary signal cannot be accurately detected.
[0003] To solve this problem, the existing practice is to set a large magnification area and a small magnification area in the working area, and switch the boundary detection sensor magnification according to the distance. When judging the interference signal, a threshold is set. When the signal is less than the threshold, it is judged as an interference signal. When the lawn mower enters the large magnification area from the small magnification area, due to the close distance to the boundary cable, there will be strong ground reflection interference, etc. The large magnification will also amplify the interference signal, and the interference signal will be misjudged as a boundary signal, resulting in false detection. Summary of the invention
[0004] Based on this, it is necessary to provide an automatic walking device and its boundary signal detection method to address the problem that in the existing method of switching the boundary detection sensor magnification according to distance, when the lawn mower enters the large magnification area from the small magnification area, due to the close distance to the boundary cable, there is strong ground reflection interference, and the interference signal is amplified by a large magnification, resulting in false detection.
[0005] An automatic walking device has a working mode. When in the working mode, the automatic walking device moves within a working range defined by a boundary line. The automatic walking device comprises:
[0006] body;
[0007] a first boundary detection module, installed on the fuselage, for detecting the electromagnetic field, obtaining a first detection signal, and amplifying the first detection signal by a first amplification factor to obtain and output a first amplified signal;
[0008] a second boundary detection module, installed on the body, for detecting the electromagnetic field, obtaining a second detection signal, and cyclically amplifying the second detection signal by a second amplification factor and a first amplification factor in sequence, so as to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor;
[0009] a processing module, connected to the first boundary detection module and the second boundary detection module respectively, and configured to perform interference removal processing on the first amplified signal based on a first interference threshold, and perform interference removal processing on the second amplified signal and the third amplified signal based on a second interference threshold; if no signal can be obtained after the interference removal processing on the first amplified signal and the interference removal processing on the third amplified signal, perform interference removal processing on the first amplified signal based on a third interference threshold, and the third interference threshold is less than the first interference threshold and the second interference threshold; and when the first amplified signal is subjected to interference removal processing based on the third interference threshold to obtain a third interference-removed amplified signal, and when the second amplified signal is subjected to interference removal processing based on the second interference threshold to obtain a second interference-removed amplified signal, compositely determine whether a boundary signal exists based on the third interference-removed amplified signal and the second interference-removed amplified signal.
[0010] In one embodiment, the second magnification is greater than the first magnification.
[0011] In one of the embodiments, the first boundary detection module includes a first signal receiving unit and a first signal amplifying unit, the first signal receiving unit is used to detect the electromagnetic field in the environment to obtain a first detection signal, and the first signal amplifying unit is used to amplify the first detection signal by a first amplification factor;
[0012] The second boundary detection module includes a second signal receiving unit and a second signal amplifying unit, the second signal receiving unit is used to detect the electromagnetic field in the environment to obtain a second detection signal, and the second signal amplifying unit is used to cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence.
[0013] In one of the embodiments, the first boundary detection module includes a first boundary detection submodule and a third boundary detection submodule;
[0014] The first boundary detection submodule includes a first signal receiving subunit and a first signal amplifying subunit, the first signal receiving subunit is used to detect the electromagnetic field in the environment and obtain a first sub-detection signal, and the first signal amplifying subunit is used to amplify the first sub-detection signal by a first amplification factor;
[0015] The third boundary detection submodule includes a third signal receiving subunit and a third signal amplifying subunit. The third signal receiving subunit is used to detect the electromagnetic field in the environment and obtain a third sub-detection signal. The third signal amplifying subunit is used to amplify the third sub-detection signal by a first amplification factor.
[0016] In one embodiment, the first boundary detection module, the second boundary detection module and the processing module are integrated on the same circuit board.
[0017] A boundary signal detection method for an automatic walking device, the automatic walking device having a working mode, when in the working mode, the automatic walking device moves within a working range defined by a boundary line, the automatic walking device comprising a first boundary detection module and a second boundary detection module, the first boundary detection module being used to detect an electromagnetic field, obtain a first detection signal, and amplify the first detection signal by a first amplification factor to obtain and output a first amplified signal; the second boundary detection module being used to detect an electromagnetic field, obtain a second detection signal, and cyclically amplify the second detection signal by a second amplification factor and the first amplification factor in sequence to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor; the second amplification factor being greater than the first amplification factor; the boundary signal detection method comprising:
[0018] performing interference removal processing on the first amplified signal based on a first interference threshold, and performing interference removal processing on the second amplified signal and the third amplified signal based on a second interference threshold;
[0019] If no signal can be obtained after performing interference removal processing on the first amplified signal and performing interference removal processing on the third amplified signal, performing interference removal processing on the first amplified signal based on a third interference threshold, wherein the third interference threshold is smaller than the first interference threshold and the second interference threshold;
[0020] When the first amplified signal is de-interferenceed based on the third interference threshold to obtain a third de-interferenceed amplified signal, and the second amplified signal is de-interferenceed based on the second interference threshold to obtain a second de-interferenceed amplified signal, it is determined whether a boundary signal exists based on the third de-interferenceed amplified signal and the second de-interferenceed amplified signal.
[0021] In one embodiment, the method further comprises:
[0022] If interference removal processing is performed on the first amplified signal based on the first interference threshold to obtain a first interference-removed amplified signal, it is determined whether a boundary signal exists based on the first interference-removed amplified signal.
[0023] In one embodiment, the method further comprises:
[0024] If no signal can be obtained by performing interference removal processing on the first amplified signal based on the third interference threshold, and if a second interference-removed amplified signal is obtained by performing interference removal processing on the second amplified signal based on the second interference threshold, it is determined whether a boundary signal exists based on the second interference-removed amplified signal.
[0025] In one embodiment, the method further comprises:
[0026] If interference removal processing is performed on the third amplified signal based on the second interference threshold to obtain an interference-removed amplified signal, interference removal processing is performed on the first amplified signal based on the first interference threshold.
[0027] In one embodiment, the first boundary detection module includes a first boundary detection submodule and a third boundary detection submodule, the first boundary detection submodule is used to detect the electromagnetic field, obtain a first sub-detection signal, and amplify the first sub-detection signal by a first magnification factor to obtain and output a first sub-amplified signal, the third boundary detection submodule is used to detect the electromagnetic field, obtain a third sub-detection signal, and amplify the third sub-detection signal by a first magnification factor to obtain and output a third sub-amplified signal;
[0028] When the first sub-amplified signal is subjected to interference removal processing based on the third interference threshold, an interference-removed amplified signal can be obtained, and / or the third sub-amplified signal is subjected to interference removal processing based on the third interference threshold, an interference-removed amplified signal can be obtained, and it is determined that the first amplified signal is subjected to interference removal processing based on the third interference threshold, so that the third interference-removed amplified signal can be obtained.
[0029] The above-mentioned automatic walking device has two boundary detection modules, namely, a first boundary detection module with a fixed first magnification and a second boundary detection module with a first magnification and a second magnification that are cyclically switched. When the automatic walking device is working in the working mode, the first detection signal can be obtained by detecting the electromagnetic field through the first boundary detection module, and the first detection signal can be amplified by the first magnification to obtain the first amplified signal. At the same time, the electromagnetic field can be detected by the second boundary detection module to obtain the second detection signal, and the second detection signal can be cyclically amplified by the second amplification factor and the first amplification factor in turn to obtain the second amplified signal and the third amplified signal. Then, the first amplified signal is de-interference processed based on the first interference threshold, and the second amplified signal and the third amplified signal are de-interference processed based on the second interference threshold. If the first amplified signal is de-interference processed and the third amplified signal is de-interference processed, the first amplified signal is de-interference processed based on the third interference threshold that is less than the first interference threshold. When the first amplified signal is de-interferenceed based on the third interference threshold to obtain the third de-interference amplified signal, and when the second amplified signal is de-interferenceed based on the second interference threshold to obtain the second de-interference amplified signal, it is determined whether a boundary signal exists based on the third de-interference amplified signal and the second de-interference amplified signal. Thus, by reducing the first interference threshold to the third interference threshold, de-interferenceing the first amplified signal with the third interference threshold, and determining whether a boundary signal exists based on the third de-interference amplified signal and the second de-interference amplified signal, it is avoided that when the second detection signal is amplified with a larger second amplification factor, the interference signal such as ground reflection interference is also amplified by the second amplification factor, causing a false detection of the boundary signal, thereby enhancing the anti-interference capability and improving the accuracy of boundary signal detection. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 This is a schematic diagram of an application scenario in which an automatic walking device is in working mode;
[0031] Figure 2 This is a schematic diagram of an application scenario in which an automatic walking device is in a regression mode;
[0032] Figure 3 A schematic diagram of the structure of the automatic walking device provided in Example 1;
[0033] Figure 4 A schematic diagram of the structure of the automatic walking device provided in Example 1;
[0034] Figure 5 A schematic structural diagram of an automatic walking device according to another embodiment of the present invention;
[0035] Figure 6 A schematic structural diagram of an automatic walking device according to another embodiment of the present invention;
[0036] Figure 7 A flowchart of a boundary signal detection method for an automatic walking device provided in Example 2;
[0037] Figure 8 This is a structural schematic diagram corresponding to a specific example of the boundary signal detection method for an automatic walking device provided in Example 2.
[0038] Description of reference numerals:
[0039] 10. Fuselage; 101. Central axis; 20. Travel module; 30. First boundary detection module; 301. First boundary detection submodule; 3011. First signal receiving subunit; 3012. First signal amplifying subunit; 302. Third boundary detection submodule; 3021. Third signal receiving subunit; 3022. Third signal amplifying subunit; 303. First signal receiving unit; 304. First signal amplifying unit; 40. Second boundary detection module; 401. Second signal receiving unit; 402. Second signal amplifying unit; 50. Processing module; 60. Automatic travel device; 70. Boundary line; 80. Stop. DETAILED DESCRIPTION
[0040] In order to facilitate understanding of the present application, the present application will be described more fully below with reference to the relevant drawings. Embodiments of the present application are provided in the drawings. However, the present application can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the disclosure of the present application more thorough and comprehensive.
[0041] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which this application belongs. The terms used herein in the specification of this application are only for the purpose of describing specific embodiments and are not intended to limit this application.
[0042] It can be understood that the terms "first", "second", etc. used in the present application can be used in this article to describe various elements, but these elements are not limited by these terms. These terms are only used to distinguish the first element from another element.
[0043] It should be noted that when an element is referred to as being "mounted on" another element, it may be directly on the other element or there may also be a centered element. When an element is considered to be "connected" to another element, it may be directly connected to the other element or there may be a centered element at the same time. In addition, the "connection" in the following embodiments should be understood as "electrical connection", "communication connection", etc. if there is a transmission of electrical signals or data between the connected objects. The terms "vertical", "horizontal", "left", "right", "up", "down", "front", "back", "circumferential" and similar expressions used herein are based on the orientation or positional relationship shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention.
[0044] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those generally understood by those skilled in the art of the present invention. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more related listed items.
[0045] Embodiment 1
[0046] An embodiment of the present application provides an automatic walking device, which may be a lawn mower robot, a sweeping robot, a snow sweeper, or other intelligent device with an automatic walking function.
[0047] The automatic walking device provided in this embodiment has a working mode and a return mode. Figure 1 As shown, when it is in working mode, the autonomous vehicle 60 moves within the working range defined by the boundary line 70 and performs working tasks, such as mowing, sweeping snow, or mopping the floor; Figure 2 As shown, when in the return mode, the automatic walking device 60 moves along the boundary line 70 to the docking station 80 and docks with the docking station 80 to realize the return function. Among them, the boundary line 70 is used to define the working range of the automatic walking device 60, and the docking station 80 is set on the boundary line 70, which is used to send a pulse current to the boundary line 70, and then generate a boundary signal through the boundary line 70, and the boundary signal is a magnetic field signal. When the automatic walking device 60 is in the working mode, the automatic walking device 60 determines the current position by detecting the boundary signal emitted by the boundary line 70.
[0048] like Figure 3 and 4 As shown, the automatic walking device 60 provided in this embodiment includes a body 10 , a walking module 20 , a first boundary detection module 30 , a second boundary detection module 40 and a processing module 50 .
[0049] Among them, the walking module 20 is installed on the fuselage 10 and arranged at the bottom of the fuselage 10. It is used to support the fuselage 10 and to drive the automatic walking device 60 to move under the action of a driving force. In actual applications, the driving force can be provided by a driving motor.
[0050] The first boundary detection module 30 and the second boundary detection module 40 are installed on the fuselage 10, and the first boundary detection module 30 and the second boundary detection module 40 can be directly or indirectly connected to the fuselage 10. When the automatic walking device 60 is in the working mode, the walking module 20 drives the automatic walking device 60 to move, and the first boundary detection module 30 and the second boundary detection module 40 move together, and detect boundary signals in real time.
[0051] In this embodiment, the first boundary detection module 30 is used to detect electromagnetic field signals in the environment, obtain a first detection signal, and amplify the first detection signal by a first amplification factor to obtain and output a first amplified signal. The electromagnetic field signals in the environment may include boundary signals emitted by the boundary line 70 and other electromagnetic field signals in the environment.
[0052] Specifically, Figure 5 As shown, the first boundary detection module 30 may include a first signal receiving unit 303 and a first signal amplifying unit 304. The first signal receiving unit 303 is used to detect the electromagnetic field in the environment to obtain a first detection signal, and the first signal amplifying unit 304 is used to amplify the first detection signal by a first amplification factor. The first signal receiving unit 303 may be a magnetic induction coil, and the first signal amplifying unit 304 may be a signal amplifier.
[0053] The second boundary detection module 40 is used to detect the electromagnetic field in the environment, obtain a second detection signal, and cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor.
[0054] Preferably, the second magnification is greater than the first magnification. The first magnification and the second magnification can be set according to actual needs. For example, assuming that it is necessary to ensure that the signal can be detected within 70 meters from the boundary line, the second magnification can be set to about 10 times the first magnification to ensure that the second boundary detection module 40 can detect the signal when it is at the second magnification within ten meters, so as to avoid the second magnification being too large and causing the amplified boundary signal to be a headless signal, resulting in the inability to detect the signal or the need to further process the detected signal.
[0055] Specifically, the second boundary detection module 40 may include a second signal receiving unit 401 and a second signal amplifying unit 402, wherein the second signal receiving unit 401 is used to detect the electromagnetic field in the environment to obtain a second detection signal, and the second signal amplifying unit 402 is used to cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence. The second signal amplifying unit 402 cyclically amplifies the second detection signal by a second amplification factor and a first amplification factor in a preset period, and the preset period can be set to 30ms, 40ms, 50ms, etc., which is not specifically limited here. In this embodiment, the second signal receiving unit 401 may be a magnetic induction coil, and the second signal amplifying unit 402 may be a signal amplifier.
[0056] The processing module 50 is connected to the first boundary detection module 30, the second boundary detection module 40 and the walking module 20 respectively, and is used to perform interference removal processing on the first amplified signal based on the first interference threshold, and to perform interference removal processing on the second amplified signal and the third amplified signal based on the second interference threshold. That is, remove the signal below the first interference threshold in the first amplified signal, and remove the signal below the second interference threshold in the second amplified signal and the third amplified signal. Then, the boundary signal is analyzed for the first amplified signal from which the signal below the first interference threshold is removed, and the second amplified signal and the third amplified signal from which the signal below the second interference threshold is removed. Specifically, the boundary signal that meets the above signal characteristic values can be analyzed according to the signal characteristic values such as edge (including rising edge and falling edge), signal strength, amplitude ratio (including signal peak, trough amplitude ratio), frequency and period. Finally, the walking module 20 is controlled according to the detection result of the boundary signal. Specifically, the processing module can determine whether the boundary signal is detected according to the boundary signal detection result of each amplified signal when the automatic walking device 60 is in the working mode, and control the walking module 20 to continue moving when the boundary signal is detected, and control the walking module 20 to stop moving when the boundary signal is not detected.
[0057] If the processing module 50 performs interference removal processing on the first amplified signal and interference removal processing on the third amplified signal, and both cannot parse and obtain a signal, then interference removal processing is performed on the first amplified signal based on the third interference threshold, and the third interference threshold is less than the first interference threshold and the second interference threshold. When the first amplified signal is subjected to interference removal processing based on the third interference threshold to obtain the third interference-removed amplified signal, and the second amplified signal is subjected to interference removal processing based on the second interference threshold to obtain the second interference-removed amplified signal, it is determined whether a boundary signal exists based on the third interference-removed amplified signal and the second interference-removed amplified signal.
[0058] Specifically, if the third interference-removed amplified signal is analyzed and the second interference-removed amplified signal is analyzed, and both can obtain signals that meet the signal characteristic value, it is judged that there is a boundary signal, otherwise it is judged that there is no boundary signal. By performing a composite judgment on the boundary signal analysis results of the third interference-removed amplified signal and the second interference-removed amplified signal, compared with only analyzing and judging the second interference-removed amplified signal, the situation of false detection of the boundary signal caused by the interference signal also being amplified by the second amplification factor is avoided, and the accuracy of boundary signal detection is improved.
[0059] In this embodiment, the first interference threshold and the second interference threshold may be the same or different, and the third interference threshold is smaller than the first interference threshold and the second interference threshold.
[0060] In one embodiment, the first boundary detection module 30 further includes a first filtering unit, which is connected to the first signal receiving unit 303 and the first signal amplifying unit 304, respectively, and is used to filter out the signal of a preset frequency in the first detection signal. In practical applications, the first filtering unit can filter out the signal of a frequency value higher than the upper limit and the signal of a frequency value lower than the lower limit in the first detection signal.
[0061] Similarly, the second boundary detection module 40 also includes a second filtering unit, which is connected to the second signal receiving unit 401 and the second signal amplifying unit 402, respectively, and is used to filter out the signal of the preset frequency in the second detection signal. In practical applications, the second filtering unit can filter out the signal of the second detection signal that is higher than the upper limit frequency value and the signal that is lower than the lower limit frequency value.
[0062] The detection signal can be pre-processed by the above-mentioned filtering unit to filter out high-frequency signals and low-frequency signals, which helps to reduce the internal calculation amount of subsequent signal processing.
[0063] The first filtering unit and the second filtering unit may use hardware filtering circuits.
[0064] In one embodiment, if Figure 6As shown, the first boundary detection module 30 includes a first boundary detection submodule 301 and a third boundary detection submodule 302. The first boundary detection submodule 301 includes a first signal receiving subunit 3011 and a first signal amplifying subunit 3012. The first signal receiving subunit 3011 is used to detect the electromagnetic field in the environment and obtain the first sub-detection signal. The first signal amplifying subunit 3012 is used to amplify the first sub-detection signal by a first magnification factor. The third boundary detection submodule 302 includes a third signal receiving subunit 3021 and a third signal amplifying subunit 3022. The third signal receiving subunit 3021 is used to detect the electromagnetic field in the environment and obtain the third sub-detection signal. The third signal amplifying subunit 3022 is used to amplify the third sub-detection signal by a first magnification factor.
[0065] The first signal receiving subunit 3011 and the third signal receiving subunit 3021 are symmetrically distributed on both sides of the second signal receiving unit 401 .
[0066] In one embodiment, if Figure 4 As shown, the fuselage 10 has a central axis 101, the second signal receiving unit 401 is arranged on the central axis 101, the first signal receiving subunit 3011 and the third signal receiving subunit 3021 are symmetrically arranged about the central axis 101, and the first signal receiving subunit 3011, the second signal receiving unit 401 and the third signal receiving subunit 3021 are located on a straight line perpendicular to the central axis 101, but some errors are not ruled out, such as deviating from the straight line by 1-2 cm.
[0067] Of course, the first boundary detection module 30 may also include more boundary detection submodules. In this embodiment, it is preferably configured to include two boundary detection submodules.
[0068] In one embodiment, the first boundary detection module 30, the second boundary detection module 40 and the processing module 50 are integrated on the same circuit board for easy installation and removal. The processing module 50 may include only one main processor, which is connected to the first boundary detection module 30 and the second boundary detection module 40 respectively. The processing module 50 may also include a sub-processor and a main processor, the first boundary detection module 30 and the second boundary detection module 40 are connected to the sub-processor respectively, and the sub-processor is connected to the main processor.
[0069] Embodiment 2
[0070] The embodiment of the present application provides a boundary signal detection method of an automatic walking device 60, wherein the automatic walking device 60 has a working mode. When in the working mode, the automatic walking device 60 moves within the working range defined by the boundary line 70, and the automatic walking device 60 includes a first boundary detection module 30 and a second boundary detection module 40. The first boundary detection module 30 is used to detect the electromagnetic field, obtain a first detection signal, and amplify the first detection signal by a first magnification factor to obtain and output the first amplified signal. The second boundary detection module 40 is used to detect the electromagnetic field, obtain a second detection signal, and cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in turn to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor. The second amplification factor is greater than the first amplification factor.
[0071] For the specific structure of the above automatic walking device, please refer to the relevant description in Example 1, which will not be repeated here.
[0072] The boundary signal detection method provided in this embodiment is applied to the working process of the automatic walking device in the working mode, such as Figure 7 As shown, the method includes:
[0073] Step S20: performing interference removal processing on the first amplified signal based on the first interference threshold, and performing interference removal processing on the second amplified signal and the third amplified signal based on the second interference threshold.
[0074] Specifically, performing interference removal processing on the first amplified signal based on the first interference threshold refers to removing signals below the first interference threshold in the first amplified signal. Performing interference removal processing on the second amplified signal and the third amplified signal based on the second interference threshold refers to removing signals below the second interference threshold in the second amplified signal and the third amplified signal. The first interference threshold and the second interference threshold may be the same or different.
[0075] Step S22: If no signal can be obtained after the first amplified signal and the third amplified signal are subjected to interference removal processing, the first amplified signal is subjected to interference removal processing based on a third interference threshold, and the third interference threshold is smaller than the first interference threshold and the second interference threshold.
[0076] That is, after performing interference removal processing on the first amplified signal obtained by amplifying the first detection signal with a smaller first amplification factor, and the third amplified signal obtained by amplifying the second detection signal with a smaller first amplification factor, if no boundary signal can be obtained after analysis, then interference removal processing is performed on the first amplified signal with a third interference threshold that is smaller than the first interference threshold.
[0077] Specifically, when the boundary signal emitted from the boundary line 70 is weak or the distance from the boundary line 70 is far, the boundary signal may not be detected with a smaller first amplification factor. At this time, the first interference threshold can be reduced to a third interference threshold, and the first amplified signal is de-interferenceed with a smaller third interference threshold. The third interference threshold can be half of the first interference threshold, or one-third of the first interference threshold, or other values, depending on actual needs, and is not specifically limited here.
[0078] Step S24: when the first amplified signal is de-interferenceed based on the third interference threshold to obtain a third de-interferenceed amplified signal, and the second amplified signal is de-interferenceed based on the second interference threshold to obtain a second de-interferenceed amplified signal, it is determined whether a boundary signal exists based on the third de-interferenceed amplified signal and the second de-interferenceed amplified signal.
[0079] Since the second boundary detection module 40 cyclically amplifies the second detection signal by a larger second amplification factor and a smaller first amplification factor in sequence, and obtains and outputs a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor, when the boundary signal cannot be parsed after the third amplified signal is de-interference processed, it can be further judged based on whether the boundary signal can be parsed after the second amplified signal is de-interference processed, and at the same time, it can be judged based on the third interference threshold whether the boundary signal can be parsed after the first amplified signal is de-interference processed, and the above two judgment results are comprehensively considered to finally determine whether the boundary signal is detected.
[0080] Specifically, the first amplified signal is de-interferenceed based on the third interference threshold to obtain the third interference amplified signal, and the second amplified signal is de-interferenceed based on the second interference threshold to obtain the second de-interference amplified signal, and the boundary signal of the third de-interference amplified signal and the second de-interference amplified signal are respectively analyzed, and whether the boundary signal is detected is determined based on the boundary signal analysis results of the two. In this way, by reducing the first interference threshold to the third interference threshold and de-interference-processing the first amplified signal with the third interference threshold, it is avoided that when the detection signal is amplified with a larger second amplification factor, the interference signal such as ground reflection interference is also amplified by the second amplification factor, causing the boundary signal to be misdetected, thereby enhancing the anti-interference capability and improving the accuracy of boundary signal detection.
[0081] Among them, if the boundary signal can be parsed based on both the third interference removal amplified signal and the second interference removal amplified signal, it is determined that the boundary signal exists; if the boundary signal cannot be parsed based on the third interference removal amplified signal, but the boundary signal can be parsed based on the second interference removal amplified signal, it is also determined that the boundary signal exists. At this time, the automatic walking device 60 is far away from the boundary line 70, for example, the automatic walking device 60 is located in the middle position of the working range defined by the boundary line 70; if the boundary signal cannot be parsed based on the third interference removal amplified signal and the second interference removal amplified signal, it is determined that the boundary signal does not exist. At this time, the position of the automatic walking device 60 cannot be determined, and the automatic walking device 60 stops working.
[0082] It should be noted that, assuming that the boundary signal can be parsed based on the third interference removal amplified signal, but the boundary signal cannot be parsed based on the second interference removal amplified signal, and this state lasts for a period of time, there may be a fault inside the second boundary detection module 40, such as a fault in the second signal receiving unit 401.
[0083] In one embodiment, when the first amplified signal is subjected to interference removal processing based on the first interference threshold to obtain the first interference-removed amplified signal, it is determined whether there is a boundary signal based on the first interference-removed amplified signal. That is, after the first amplified signal is subjected to interference removal processing based on the first interference threshold and the first interference-removed amplified signal is obtained, the first interference-removed amplified signal is subjected to boundary signal analysis, and if the boundary signal is obtained by the analysis, it is determined that there is a boundary signal. At this time, the automatic walking device 60 is close to the boundary line 70.
[0084] In one embodiment, if the first amplified signal is de-interferenceed based on the third interference threshold, no signal can be obtained, and the second amplified signal is de-interferenceed based on the second interference threshold, when the second de-interferenced amplified signal is obtained, it is determined whether a boundary signal exists based on the second de-interferenced amplified signal. That is, the second de-interferenced amplified signal is analyzed for boundary signals, and if the boundary signal is obtained by the analysis, it is determined that a boundary signal exists. At this time, the automatic walking device 60 is far away from the boundary line 70.
[0085] In one embodiment, if the third amplified signal is subjected to interference removal processing based on the second interference threshold to obtain the interference-removed amplified signal, the first amplified signal is subjected to interference removal processing based on the first interference threshold. That is, as the automatic walking device 60 moves, once the third amplified signal is subjected to interference removal processing based on the second interference threshold to obtain the interference-removed amplified signal, and the boundary signal can be parsed, the third interference threshold is adjusted to the first interference threshold, and the first amplified signal is subjected to interference removal processing based on the first interference threshold, and the process returns to step S20.
[0086] In one embodiment, the first boundary detection module 30 includes a first boundary detection submodule 301 and a third boundary detection submodule 302. The first boundary detection submodule 301 is used to detect the electromagnetic field, obtain a first sub-detection signal, and amplify the first sub-detection signal by a first amplification factor to obtain and output the first sub-amplified signal. The third boundary detection submodule 302 is used to detect the electromagnetic field, obtain a third sub-detection signal, and amplify the third sub-detection signal by a first amplification factor to obtain and output the third sub-amplified signal.
[0087] When the first sub-amplified signal is subjected to interference removal processing based on the third interference threshold, the interference-removed amplified signal can be obtained, and / or the third sub-amplified signal is subjected to interference removal processing based on the third interference threshold, the interference-removed amplified signal can be obtained, and it is determined that the first amplified signal is subjected to interference removal processing based on the third interference threshold, so that the third interference-removed amplified signal can be obtained.
[0088] Setting the first boundary detection submodule 301 and the third boundary detection submodule 302 at the same time, and processing and judging their output signals at the same time, helps to improve the accuracy of boundary detection and avoid false detection.
[0089] The boundary signal detection method provided by this embodiment is described below with a specific example (refer to Figure 8 ):
[0090] The automatic walking device 60 includes a first boundary detection submodule 301, a second boundary detection module and a third boundary detection submodule. The first boundary detection submodule 301 includes a first signal receiving subunit 3011 and a first signal amplifying subunit 3012. The first signal receiving subunit 3011 is used to detect the electromagnetic field in the environment and obtain a first sub-detection signal. The first signal amplifying subunit 3012 is used to amplify the first sub-detection signal by a first magnification factor to obtain and output the first sub-amplified signal. The third boundary detection submodule 302 includes a third signal receiving subunit 3021 and a third signal amplifying subunit 3022. The third signal receiving subunit 3021 is used to detect the electromagnetic field in the environment and obtain a third sub-detection signal. The third signal amplifying subunit 3022 is used to amplify the third sub-detection signal by a first magnification factor to obtain and output the third sub-amplified signal. The second boundary detection module 40 may include a second signal receiving unit 401 and a second signal amplifying unit 402, wherein the second signal receiving unit 401 is used to detect the electromagnetic field in the environment to obtain a second detection signal, and the second signal amplifying unit 402 is used to cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor. The first signal receiving subunit 3011 and the third signal receiving subunit 3021 are symmetrically arranged on both sides of the second signal receiving unit 401.
[0091] The automatic moving device 60 is controlled to enter the working mode, that is, to move and work within the working range defined by the boundary line 70. The first interference threshold and the second interference threshold are both set to the interference threshold T.
[0092] Based on the interference threshold T, the first sub-amplified signal, the third sub-amplified signal, the second amplified signal and the third amplified signal are subjected to interference removal processing and boundary signal analysis;
[0093] If the above analysis can parse out the boundary signal, it is determined that there is a boundary signal and the automatic moving device 60 is located in the A area close to the boundary line 70;
[0094] If the first sub-amplified signal, the third sub-amplified signal, and the third amplified signal cannot be resolved to obtain a boundary signal after interference removal processing based on the interference threshold T, then the first sub-amplified signal and the third sub-amplified signal are subjected to interference removal processing based on the interference threshold T / 2 and the boundary signal is resolved, and at least one of the two can resolve the boundary signal, and the second amplified signal can also be resolved to obtain a boundary signal after interference removal processing based on the interference threshold T, and when the waveform directions of the boundary signals resolved above are the same, it is determined that there is a boundary signal, and the automatic walking device 60 is located in the B area slightly away from the boundary line 70;
[0095] If the first sub-amplified signal and the third sub-amplified signal are subjected to interference removal processing and boundary signal analysis based on the interference threshold value T / 2, and both cannot analyze the boundary signal, but the second amplified signal can analyze the boundary signal after interference removal processing based on the interference threshold value T, it is determined that there is a boundary signal, and the automatic walking device 60 is located in the C area far away from the boundary line 70;
[0096] Continue to detect, when the first sub-amplified signal and the third sub-amplified signal are de-interference processed and the boundary signal is analyzed based on the interference threshold T / 2, at least one of the two can be analyzed to obtain the boundary signal, and the second amplified signal can be analyzed to obtain the boundary signal after de-interference processing based on the interference threshold T, it is determined that there is a boundary signal, and the automatic walking device 60 returns from area C to area B;
[0097] When the third amplified signal is de-interferenceed based on the interference threshold T and the boundary signal can be parsed again, it is considered that the automatic walking device 60 has returned to the A area from the B area. At this time, the interference threshold T / 2 set for the de-interference processing of the first sub-amplified signal and the third sub-amplified signal is adjusted to T, and the de-interference processing of the first sub-amplified signal and the third sub-amplified signal is restored to the interference threshold T.
[0098] The above-mentioned areas A, B and C are only assumed for illustrating the scheme of the present application. In actual applications, areas A, B and C respectively represent the area within the working range that is close to the boundary line 70, the area slightly far from the boundary line 70 and the area far from the boundary line 70.
[0099] It should be noted that the automatic walking device provided in the above embodiment, when realizing its functions, is only illustrated by the division of the above functional modules. In practical applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above. In addition, the automatic walking device provided in the above embodiment and the method embodiment belong to the same concept, and its specific implementation process is detailed in the method embodiment, which will not be repeated here.
[0100] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0101] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. An automatic walking device, having a working mode, wherein when in the working mode, the automatic walking device moves within a working range defined by a boundary line, characterized in that: The automatic walking device comprises: body; a first boundary detection module, installed on the fuselage, for detecting the electromagnetic field, obtaining a first detection signal, and amplifying the first detection signal by a first amplification factor to obtain and output a first amplified signal; a second boundary detection module, installed on the fuselage, for detecting the electromagnetic field, obtaining a second detection signal, and cyclically amplifying the second detection signal by a second amplification factor and a first amplification factor in sequence, so as to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor, wherein the second amplification factor is greater than the first amplification factor; a processing module, connected to the first boundary detection module and the second boundary detection module respectively, and configured to: perform interference removal processing on the first amplified signal based on a first interference threshold, and perform interference removal processing on the second amplified signal and the third amplified signal based on a second interference threshold; if no signal can be obtained after the interference removal processing on the first amplified signal and the interference removal processing on the third amplified signal, perform interference removal processing on the first amplified signal based on a third interference threshold, and the third interference threshold is less than the first interference threshold and the second interference threshold; and when the first amplified signal is subjected to interference removal processing based on the third interference threshold to obtain a third interference-removed amplified signal, and when the second amplified signal is subjected to interference removal processing based on the second interference threshold to obtain a second interference-removed amplified signal, compositely determine whether there is a boundary signal based on the third interference-removed amplified signal and the second interference-removed amplified signal; The processing module is specifically used to: if the third interference-removed amplified signal and the second interference-removed amplified signal are analyzed to obtain signals that meet the signal characteristic value, then determine that there is a boundary signal.
2. The automatic walking device according to claim 1, characterized in that: The processing module is further specifically used for: If the boundary signal cannot be parsed out based on the third interference-removed amplified signal, but the boundary signal can be parsed out based on the second interference-removed amplified signal, it is determined that the boundary signal exists; If the boundary signal cannot be parsed out based on the third interference-removed amplified signal and the second interference-removed amplified signal, it is determined that there is no boundary signal; The processing module is further specifically used to: if a boundary signal can be parsed out based on the third interference-removed amplified signal, but a boundary signal cannot be parsed out based on the second interference-removed amplified signal, and this state lasts for a period of time, determine that a fault occurs inside the second boundary detection module.
3. The automatic walking device according to claim 2, characterized in that: The first boundary detection module includes a first signal receiving unit and a first signal amplifying unit, the first signal receiving unit is used to detect the electromagnetic field in the environment to obtain a first detection signal, and the first signal amplifying unit is used to amplify the first detection signal by a first amplification factor; The second boundary detection module includes a second signal receiving unit and a second signal amplifying unit, the second signal receiving unit is used to detect the electromagnetic field in the environment to obtain a second detection signal, and the second signal amplifying unit is used to cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence; The first boundary detection module further includes a first filtering unit, which is connected to the first signal receiving unit and the first signal amplifying unit respectively and is used to filter out a signal of a preset frequency in the first detection signal; The second boundary detection module further includes a second filtering unit, which is connected to the second signal receiving unit and the second signal amplifying unit respectively and is used to filter out a signal of a preset frequency in the second detection signal.
4. The automatic walking device according to claim 3, characterized in that: The first boundary detection module includes a first boundary detection submodule and a third boundary detection submodule; The first boundary detection submodule includes a first signal receiving subunit and a first signal amplifying subunit, the first signal receiving subunit is used to detect the electromagnetic field in the environment and obtain a first sub-detection signal, and the first signal amplifying subunit is used to amplify the first sub-detection signal by a first amplification factor; The third boundary detection submodule includes a third signal receiving subunit and a third signal amplifying subunit, wherein the third signal receiving subunit is used to detect the electromagnetic field in the environment and obtain a third sub-detection signal, and the third signal amplifying subunit is used to amplify the third sub-detection signal by a first amplification factor; The first signal receiving subunit and the third signal receiving subunit are symmetrically distributed on both sides of the second signal receiving unit; The fuselage has a central axis, the second signal receiving unit is arranged on the central axis, the first signal receiving subunit and the third signal receiving subunit are symmetrically arranged about the central axis, and the first signal receiving subunit, the second signal receiving unit and the third signal receiving subunit are located on a straight line perpendicular to the central axis.
5. The automatic walking device according to claim 1, characterized in that: The first boundary detection module, the second boundary detection module and the processing module are integrated on the same circuit board; the processing module is further used for: When performing interference removal processing on the first amplified signal based on the first interference threshold to obtain a first interference-removed amplified signal, determining whether there is a boundary signal based on the first interference-removed amplified signal; If the first amplified signal is subjected to interference removal processing based on the third interference threshold and a signal cannot be obtained, and the second amplified signal is subjected to interference removal processing based on the second interference threshold and the second interference-removed amplified signal is obtained, determining whether a boundary signal exists based on the second interference-removed amplified signal; If interference removal processing is performed on the third amplified signal based on the second interference threshold to obtain an interference-removed amplified signal and to resolve a boundary signal, the third interference threshold is adjusted to the first interference threshold, and interference removal processing is performed on the first amplified signal based on the first interference threshold.
6. A boundary signal detection method for an automatic walking device, characterized in that: The automatic walking device has a working mode. When in the working mode, the automatic walking device moves within a working range defined by a boundary line. The automatic walking device includes a first boundary detection module and a second boundary detection module. The first boundary detection module is used to detect an electromagnetic field, obtain a first detection signal, and amplify the first detection signal by a first magnification factor to obtain and output a first amplified signal; the second boundary detection module is used to detect an electromagnetic field, obtain a second detection signal, and cyclically amplify the second detection signal by a second amplification factor and a first amplification factor in sequence to obtain and output a second amplified signal corresponding to the second amplification factor and a third amplified signal corresponding to the first amplification factor; The second magnification is greater than the first magnification; The boundary signal detection method comprises: performing interference removal processing on the first amplified signal based on a first interference threshold, and performing interference removal processing on the second amplified signal and the third amplified signal based on a second interference threshold; If no signal can be obtained after performing interference removal processing on the first amplified signal and performing interference removal processing on the third amplified signal, performing interference removal processing on the first amplified signal based on a third interference threshold, wherein the third interference threshold is smaller than the first interference threshold and the second interference threshold; When the first amplified signal is subjected to interference removal processing based on the third interference threshold to obtain a third interference-removed amplified signal, and the second amplified signal is subjected to interference removal processing based on the second interference threshold to obtain a second interference-removed amplified signal, it is determined whether there is a boundary signal based on the third interference-removed amplified signal and the second interference-removed amplified signal; The composite determination of whether there is a boundary signal based on the third interference-removed amplified signal and the second interference-removed amplified signal comprises: If the third interference-removed amplified signal and the second interference-removed amplified signal are analyzed to obtain signals that meet the signal characteristic value, it is determined that a boundary signal exists.
7. The boundary signal detection method according to claim 6, characterized in that: The method further comprises: If interference removal processing is performed on the first amplified signal based on the first interference threshold to obtain a first interference-removed amplified signal, it is determined whether a boundary signal exists based on the first interference-removed amplified signal.
8. The boundary signal detection method according to claim 7, characterized in that: The method further comprises: If no signal can be obtained by performing interference removal processing on the first amplified signal based on the third interference threshold, and if a second interference-removed amplified signal is obtained by performing interference removal processing on the second amplified signal based on the second interference threshold, it is determined whether a boundary signal exists based on the second interference-removed amplified signal.
9. The boundary signal detection method according to claim 8, characterized in that: The method further comprises: If interference removal processing is performed on the third amplified signal based on the second interference threshold to obtain an interference-removed amplified signal, interference removal processing is performed on the first amplified signal based on the first interference threshold.
10. The boundary signal detection method according to claim 6, characterized in that: The first boundary detection module includes a first boundary detection submodule and a third boundary detection submodule, the first boundary detection submodule is used to detect the electromagnetic field, obtain a first sub-detection signal, and amplify the first sub-detection signal by a first amplification factor to obtain and output a first sub-amplified signal, the third boundary detection submodule is used to detect the electromagnetic field, obtain a third sub-detection signal, and amplify the third sub-detection signal by a first amplification factor to obtain and output a third sub-amplified signal; When the interference removal processing of the first sub-amplified signal is performed based on the third interference threshold, the interference-removed amplified signal can be obtained, and / or the interference removal processing of the third sub-amplified signal is performed based on the third interference threshold, the interference-removed amplified signal can be obtained, it is determined that the interference removal processing of the first amplified signal is performed based on the third interference threshold, so that the third interference-removed amplified signal can be obtained; The composite determination of whether there is a boundary signal based on the third interference-removed amplified signal and the second interference-removed amplified signal further includes: If the boundary signal cannot be parsed out based on the third interference-removed amplified signal, but the boundary signal can be parsed out based on the second interference-removed amplified signal, it is determined that the boundary signal exists; If the boundary signal cannot be parsed out based on the third interference-removed amplified signal and the second interference-removed amplified signal, it is determined that there is no boundary signal; If a boundary signal can be parsed out based on the third interference-removed amplified signal, but a boundary signal cannot be parsed out based on the second interference-removed amplified signal, and this state lasts for a period of time, it is determined that a fault occurs inside the second boundary detection module.
Citation Information
Patent Citations
Mobile terminal and method of controlling the mobile terminal
CN103327169A
Guide system and control method thereof
CN103543745A
Automatic operation system, control method thereof and automatic travelling apparatus
CN106843199A
Automatic mobile device, automatic working system and control method of automatic working system
CN108227692A
Automatic walking equipment and boundary distance detection method, device and system
CN108536136A
