A collision position detection method for a self-moving device and a self-moving device
By using a combination of pressure sensors and inertial sensors in sweeping robots, we can judge the obstacle crossing state and set the appropriate low-pass filtering frequency, solving the accuracy of collision detection in complex scenarios, and improving the reliability of collision detection of sweeping robots and Movement stability.
Patent Information
- Application Number
- CN202211288694.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2021-10-26
- Filing Date
- 2022-10-20
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-10-20
AI Technical Summary
Existing sweeping robots find it difficult to accurately detect collision positions in complex scenarios, especially when crossing obstacles and collide with soft and light objects, it is easy to misjudgment or fail to recognize collision signals, affecting their normal movement.
Use at least two pressure sensors and inertial sensors to determine whether the device is in an obstacle-blocking state through acceleration information and angular velocity information, and set different low-pass filtering frequencies according to different states to improve the accuracy and sensitivity of the signal and ensure the accurate calculation of the collision position. .
It effectively reduces misjudgment when crossing obstacles, improves the reliability of collision detection, and can accurately calculate the collision position and force, ensuring that the sweeping robot works normally in complex environments.
Smart Images

Figure CN115486769B_ABST
Abstract
Description
[0001] Priority information: This application claims priority to the Chinese invention patent application filed on October 26, 2021, with application number 202111248183.5, the entire contents of which are incorporated herein by reference. Technical Field
[0002] The present invention relates to the technical field of self-moving equipment, and in particular to a self-moving equipment collision position detection method and the self-moving equipment. Background Art
[0003] Self-moving devices, such as sweeping robots and automatic lawn mowers, are devices that can automatically move around in a work area. For example, sweeping robots can move around indoors to perform vacuuming, sweeping, mopping, and other cleaning operations, making life easier for people.
[0004] During the movement of the sweeping robot, it is inevitable that it will collide with objects in the surrounding environment. After the collision occurs, it is necessary to detect the location of the collision on the self-moving device so that the sweeping robot can re-plan the path and turn to avoid getting stuck and hitting other equipment, so that the sweeping robot can move and operate intelligently. Therefore, collision detection has become increasingly important as a core element of the intelligentization of sweeping robots.
[0005] The working scenarios of sweeping robots are diverse. In complex scenarios, it is difficult for existing collision detection methods to obtain accurate detection results.
[0006] The applicant has found that when going up and down stairs (e.g. stairs less than 20 mm), crossing obstacles continuously, and crossing bumpy roads (e.g. cobblestone roads, roads with toys scattered on them, etc.), large vibrations will be generated, and the sweeping robot may mistakenly think that a collision has occurred, and thus make an erroneous obstacle avoidance action, affecting the normal movement of the sweeping robot. Furthermore, in these scenarios, if the sweeping robot collides with some soft and lightweight objects (such as soft sofas, pillows, lightweight trash cans, etc.), the signal generated by the sensor due to the collision is small and difficult to identify under large background noise, which can easily lead to the sweeping robot being unable to make accurate obstacle avoidance actions.
[0007] In addition, in the related art, the sweeping robot is mainly realized by utilizing the split collision module of the product. Taking the autonomous walking robot disclosed in the Chinese utility model patent with publication number CN211299808U as an example, it sets a collision plate at the front end and sets a sensor on the collision plate to detect the collision direction. Its detection accuracy is low, and it can only judge the approximate collision area, and it can only detect collisions close to the front side. It cannot achieve 360° detection around the whole circumference, and it is difficult to meet the complex collision detection needs in different scenarios.
[0008] Therefore, it is necessary to improve the prior art to overcome the above defects in the prior art. Summary of the invention
[0009] The object of the present invention is to provide a method for detecting a collision position of a self-moving device and a self-moving device, which can reduce misjudgment of collision when crossing obstacles and improve the reliability of collision detection.
[0010] To achieve the above-mentioned object of the invention, on the one hand, the present invention proposes a method for detecting a collision position of a self-moving device, wherein the self-moving device comprises at least two pressure sensors for detecting vibration signals and an inertial sensor for detecting acceleration information and angular velocity information;
[0011] The method for detecting the collision position of a mobile device comprises the following steps:
[0012] S1. Using the acceleration information and the angular velocity information to determine whether the self-mobile device is in an obstacle crossing state;
[0013] S2. If the device is not in the obstacle crossing state, the detection signal of the pressure sensor is low-pass filtered through a first cutoff frequency; if the device is in the obstacle crossing state, the detection signal of the pressure sensor is low-pass filtered through a second cutoff frequency, and the first cutoff frequency is higher than the second cutoff frequency;
[0014] S3. Calculate the collision position according to the filtered detection signal.
[0015] Furthermore, the first cut-off frequency is less than or equal to 2 kHz, and the second cut-off frequency is less than or equal to 80 Hz.
[0016] Furthermore, the method of using the acceleration information and the angular velocity information to determine whether the self-moving device is in an obstacle crossing state comprises the following steps:
[0017] S10. Calculating the vibration intensity according to the acceleration information;
[0018] S11. If the vibration intensity is greater than the preset vibration intensity threshold, the angular velocity change amplitude is calculated based on the angular velocity information; if the angular velocity change amplitude is greater than the preset angle threshold, it is determined to be in an obstacle crossing state; if the vibration intensity is less than the preset vibration intensity threshold, or if the angular velocity change amplitude is less than the preset angle threshold, it is determined to be not in an obstacle crossing state.
[0019] Furthermore, the vibration intensity is calculated based on the acceleration information of the three axes, and the calculation formula is as follows:
[0020]
[0021] In the formula, a is the vibration intensity, a xj 、a yj and a zj They refer to the accelerations in the x, y, and z axes collected for the jth time respectively.
[0022] The angular velocity variation is calculated based on the angular velocity information in the x-axis and y-axis directions, and the calculation formula is as follows:
[0023]
[0024] Where ω is the angular velocity variation, ω xj and ω yj are the angular velocities in the x-axis and y-axis directions collected for the jth time, respectively.
[0025] Furthermore, in step S2, the detection signal of the pressure sensor is transmitted to the processor after low-pass filtering, signal amplification and analog-to-digital conversion;
[0026] Furthermore, the signal amplification factor when in the obstacle crossing state is greater than the signal amplification factor when not in the obstacle crossing state.
[0027] Furthermore, the signal amplification factor in the obstacle crossing state is greater than or equal to 3 times the signal amplification factor in the obstacle crossing state.
[0028] Furthermore, in step S3, before calculating the collision position, it is first detected whether the vibration signal detected by the pressure sensor reaches a trigger threshold. If the trigger threshold is reached, the detection signal of the pressure sensor is collected and the collision position is calculated based on the detection signal of the pressure sensor.
[0029] Further, the self-moving device comprises a body and a shell surrounding the outside of the body, and at least a first pressure sensor and a second pressure sensor are arranged on the shell;
[0030] In step S3, calculating the collision position according to the filtered detection signal includes the following steps:
[0031] S30. Acquire detection signals of the first pressure sensor and the second pressure sensor;
[0032] S31. Calculating the transmission distance of the collision position from the first pressure sensor or the second pressure sensor according to the acquired detection signals of the first pressure sensor and the second pressure sensor;
[0033] S32. Obtain the coordinates of the collision position according to the position information of the collision position from the first pressure sensor or the second pressure sensor or the second pressure sensor and the contour information of the housing.
[0034] Further, in the step S31, the transmission distance between the collision position and the first pressure sensor or the second pressure sensor is calculated in combination with the transmission distance between the first pressure sensor and the second pressure sensor.
[0035] Furthermore, the shell is a continuous annular shell structure, and the following steps are also included before step S31:
[0036] It is determined whether the collision position is located on the first side or the second side of the line connecting the first pressure sensor and the second pressure sensor, and then the value of the transmission distance between the first pressure sensor and the second pressure sensor is determined.
[0037] Furthermore, in step S3, the collision force is also calculated according to the amplitude of the filtered detection signal.
[0038] On the other hand, the present invention provides a self-moving device, comprising:
[0039] ontology;
[0040] A shell, arranged around the outer side of the body;
[0041] at least two pressure sensors connected to the housing;
[0042] An inertial sensor is used to detect the acceleration information of the self-moving device in three axes and the angular velocity information in the X and Y axes;
[0043] a controller, which is in communication with the pressure sensor and the inertial sensor, and which determines whether the self-moving device is in an obstacle crossing state according to the acceleration information and the angular velocity information;
[0044] If the device is not in the obstacle crossing state, the detection signal of the pressure sensor is low-pass filtered through a first cutoff frequency, and the collision position is calculated according to the filtered detection signal;
[0045] If in the obstacle crossing state, the detection signal of the pressure sensor is low-pass filtered through a second cutoff frequency, and the collision position is calculated according to the filtered detection signal, and the first cutoff frequency is higher than the second cutoff frequency.
[0046] Furthermore, the first cut-off frequency is less than or equal to 2 kHz, and the second cut-off frequency is less than or equal to 80 Hz.
[0047] Further, the controller includes a processor and a first circuit and a second circuit connected between the pressure sensor and the processor;
[0048] The first circuit comprises a first low-pass filter, a first signal amplifier and a first analog-to-digital converter which are electrically connected in sequence, and the cut-off frequency of the first low-pass filter is a first cut-off frequency;
[0049] The second path includes a second low-pass filter, a second signal amplifier and a second analog-to-digital converter electrically connected in sequence, the cutoff frequency of the second low-pass filter is a second cutoff frequency, and the amplification factor of the second signal amplifier is greater than or equal to 3 times the amplification factor of the first signal amplifier.
[0050] Compared with the prior art, the present invention has the following beneficial effects:
[0051] 1. In the present invention, before calculating the collision position, it is first determined whether the self-moving device is in an obstacle crossing state, and filtering is performed with a cutoff frequency lower than that in the normal state in the obstacle crossing state, which is beneficial to extracting the signal generated by the collision from the more complex noise signal in the obstacle crossing state, preventing the self-moving device from mistakenly taking the interference signal generated by vibration as the collision signal when crossing the obstacle, which is beneficial to accurately calculate the collision position and ensure the normal operation of the self-moving device.
[0052] 2. As an improvement, the mobile device determines whether it is in an obstacle crossing state through acceleration information and angular velocity information, and the judgment result is more accurate.
[0053] 3. As an improvement, during the obstacle crossing process, by setting the cutoff frequency to less than 80Hz, the background noise can be effectively removed and the vibration signal generated by the collision can be extracted. Furthermore, by amplifying the signal, it is more convenient to obtain the useful signal after filtering, which improves the sensitivity of collision detection, so that even if the self-moving device collides with a soft or light object, it can still extract the corresponding collision signal, further improving the reliability of use. BRIEF DESCRIPTION OF THE DRAWINGS
[0054] Figure 1 The present invention is a flowchart of a method for detecting a collision position of a self-moving device according to an embodiment of the present invention.
[0055] Figure 2 The present invention is a flowchart of an embodiment of determining whether a mobile device is in an obstacle crossing state.
[0056] Figure 3 It is a flowchart of a method for detecting a collision position of a mobile device according to an embodiment of the present invention.
[0057] Figure 4 It is a structural schematic diagram of a self-moving device in an embodiment of the present invention.
[0058] Figure 5It is a cross-sectional schematic diagram of a self-moving device according to an embodiment of the present invention.
[0059] Figure 6 yes Figure 5 Schematic diagram of the structure when the shell and buffer layer are not shown.
[0060] Figure 7 It is a module schematic diagram of the controller, pressure sensor and inertial sensor in the present invention.
[0061] Figure 8 It is a module schematic diagram of a controller according to an embodiment of the present invention.
[0062] Fig. 9 It is a schematic diagram of the position of a pressure sensor on a housing according to an embodiment of the present invention.
[0063] Fig.10 It is a spectrum diagram of the induction signal of an embodiment of the present invention.
[0064] Fig.11 It is a schematic diagram of a housing provided with three pressure sensors in one embodiment of the present invention.
[0065] Fig.12 It is a schematic diagram of a housing of an embodiment of the present invention provided with three pressure sensors, in which the third pressure sensor is located in the middle of the AB arc segment.
[0066] Fig.13 It is a schematic diagram of a housing of an embodiment of the present invention including a plurality of sub-housings.
[0067] Fig.14 The figure is a flow chart of calculating the collision position in one embodiment of the present invention. DETAILED DESCRIPTION
[0068] In order to make the above-mentioned purposes, features and advantages of the present application more obvious and easy to understand, the specific implementation methods of the present application are described in detail below in conjunction with the accompanying drawings. It is understandable that the specific embodiments described herein are only used to explain the present application, rather than to limit the present application. It should also be noted that, for ease of description, only some structures related to the present application are shown in the accompanying drawings, rather than all structures. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application.
[0069] The terms "including" and "having" and any variations thereof in this application are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device comprising a series of steps or units is not limited to the listed steps or units, but may optionally include steps or units not listed, or may optionally include other steps or units inherent to these processes, methods, products or devices.
[0070] Reference to "embodiments" herein means that a particular feature, structure, or characteristic described in conjunction with the embodiments may be included in at least one embodiment of the present application. The appearance of the phrase in various locations in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.
[0071] The present invention provides a method for detecting a collision position of a self-moving device, where the self-moving device may be, for example, a sweeping robot, a lawn mower, or other devices that can move by themselves to perform operations.
[0072] The self-moving device has a function of detecting a collision position. In this embodiment, it is provided with at least two pressure sensors 4 for detecting vibration signals generated after a collision. The self-moving device can calculate the collision position according to the vibration signals detected by the pressure sensors 4 .
[0073] When a self-moving device is working, its working state can usually be divided into a normal state and an obstacle crossing state. Taking a sweeping robot as an example, the normal state is when it moves and works on a flat ground, and the obstacle crossing state is when it goes up and down stairs and passes through potholes. In the obstacle crossing state, the self-moving device will produce a large change in posture. The self-moving device also has an inertial sensor for detecting acceleration information and angular velocity information, and it detects changes in its own posture through the inertial sensor.
[0074] like Figure 1 As shown, the collision position detection method of the self-moving device of the present invention comprises the following steps:
[0075] S1. Using acceleration information and angular velocity information to determine whether the mobile device is in an obstacle crossing state;
[0076] S2. If it is not in the obstacle crossing state, the detection signal of the pressure sensor 4 is low-pass filtered through the first cutoff frequency; if it is in the obstacle crossing state, the detection signal of the pressure sensor 4 is low-pass filtered through the second cutoff frequency, and the first cutoff frequency is higher than the second cutoff frequency;
[0077] S3. Calculate the collision position according to the filtered detection signal.
[0078] In step S1, since the self-moving device often works on flat ground during normal operation, its posture changes slightly, while in the obstacle crossing state, the posture changes greatly. Therefore, the acceleration information and angular velocity information detected by the inertial sensor can determine whether the self-moving device is in the obstacle crossing state.
[0079] Furthermore, when crossing obstacles, non-collision interference signals are relatively large, resulting in a decrease in the signal-to-noise ratio. The self-moving device will generate greater background noise than in the normal state. By setting a lower cutoff frequency than in the normal working state for low-pass filtering, interference signals can be better eliminated, preventing interference signals generated by jitter and other reasons when the device crosses obstacles from being misjudged as collision signals, and filtering out vibration signals generated by collisions. In this way, by setting different cutoff frequencies for filtering in the obstacle crossing state and the non-obstacle crossing state in a targeted manner, the self-moving device can reliably filter out interference signals in different operating states, extract accurate collision signals for calculation, and facilitate accurate obstacle avoidance by the self-moving device to ensure its normal operation.
[0080] As a preferred embodiment, the first cutoff frequency is less than or equal to 2KHz, which can reliably exclude the background noise during normal operation and accurately extract the signal generated by the collision detected by the pressure sensor 4. The second cutoff frequency is less than or equal to 80Hz, which can reliably filter out the noise during obstacle crossing and prevent the interference signal caused by equipment jitter and other reasons from being misjudged as a collision. On the other hand, it can accurately extract the signal generated by the collision from the background noise, ensuring that the self-moving device can also accurately calculate the collision position during the obstacle crossing process.
[0081] Furthermore, in the above step S3, while calculating the collision position, the collision force is also calculated according to the filtered signal. The collision force is linearly correlated with the amplitude of the output signal of the pressure sensor 4, and the amplitude of the collected signal can be calibrated to characterize the magnitude of the collision force.
[0082] The signal detected by the pressure sensor 4 is an analog signal. In some embodiments, the detection signal of the pressure sensor 4 is transmitted to the processor after low-pass filtering, signal amplification and analog-to-digital conversion, and the processor performs analysis and calculation. The processor can be, for example, a single-chip microcomputer. Signal amplification can be, for example, an amplified voltage signal, a charge signal, or a current signal. The signal amplification factor is determined according to the actual situation, for example, it can be determined according to the parameters that determine the signal amplitude, such as the material, shape, and thickness of the shell. The signal amplification factor when in the obstacle crossing state is set to be greater than the signal amplification factor when not in the obstacle crossing state. After low-pass filtering, the useful signal amplitude will be reduced. By adjusting the signal amplification factor, it is beneficial to extract an accurate collision signal, and at the same time, it can meet the requirements of the digital-to-analog conversion module to prevent saturation or failure to reach the acquisition threshold. For different obstacle crossing scenarios, different signal amplification factors can also be obtained through experiments for calling.
[0083] As a preferred embodiment, the signal amplification factor in the obstacle crossing state is set to be greater than or equal to 3 times the signal amplification factor in the non-obstacle crossing state, so as to reliably eliminate noise signals and extract vibration signals generated by collision.
[0084] By adjusting the signal amplification multiple, the self-moving device can more accurately calculate the collision position and impact force even during the obstacle surmounting process, and make reasonable obstacle avoidance plans. Moreover, even if the self-moving device collides with soft and lightweight objects (such as soft sofas, pillows, lightweight trash cans, etc.) during obstacle surmounting, the vibration signal generated by the collision can be accurately extracted, thereby calculating the collision position and performing obstacle avoidance operations.
[0085] In some embodiments, reference Figure 2 and Figure 3 Step S1. The step of using the acceleration information and the angular velocity information to determine whether the mobile device is in an obstacle crossing state comprises the following steps:
[0086] S10. Calculate the vibration intensity based on the acceleration information;
[0087] S11. If the vibration intensity is greater than the preset vibration intensity threshold, the angular velocity change amplitude is calculated based on the angular velocity information. If the angular velocity change amplitude is greater than the preset angle threshold, it is determined to be in an obstacle crossing state; if the vibration intensity is less than the preset vibration intensity threshold, or if the angular velocity change amplitude is less than the preset angle threshold, it is determined to be not in an obstacle crossing state.
[0088] In step S10, a six-axis inertial sensor may be provided on the self-mobile device to detect acceleration information and angular velocity information. The six-axis inertial sensor can detect acceleration values in three axes and angular velocity values in three axes.
[0089] The vibration intensity can be calculated from the acceleration information. In a preferred embodiment, the acceleration information includes the acceleration of the mobile device in the three axes of x, y, and z. The x, y, and z axes are the three axes of the spatial rectangular coordinate system, where the x and y axes are set in the moving plane of the sweeping robot and the z axis is perpendicular to it. Assuming that the acceleration signal is collected i times in a preset period, the vibration intensity can be calculated by the following formula:
[0090]
[0091] In the formula, a is the vibration intensity, a xj 、a yj and a zj They refer to the accelerations in the x, y, and z axes collected for the jth time respectively.
[0092] In step S11, when the calculated vibration intensity is greater than the preset vibration intensity threshold, it indicates that the sweeping robot may have been hit or may be in an obstacle crossing state. At this time, the angular velocity information can be used to determine whether the sweeping robot is in an obstacle crossing state. Specifically, the amplitude of the change in angular velocity can be used to determine whether the sweeping robot is in an obstacle crossing state. When the sweeping robot is going up and down stairs or passing through potholes, the body will tilt and swing to a greater extent, resulting in a greater angular velocity change when working on a flat surface. Normal collision actions will hardly raise the chassis and cause a large change in angular velocity. Therefore, when the amplitude of the angular velocity change is greater than the preset angle threshold, it can be determined to be in an obstacle crossing state. Otherwise, it is not in an obstacle crossing state and is in a normal state.
[0093] In a preferred embodiment, the angular velocity variation amplitude is calculated by the angular velocity information of the x and y axes. Assuming that k angular velocity acquisitions are performed within a preset cycle, the angular velocity variation amplitude ω can be calculated by the following formula:
[0094]
[0095] Where ω is the angular velocity variation, ω xj and ω yj are the angular velocities in the x-axis and y-axis directions collected for the jth time, respectively.
[0096] After comparing the calculated angular velocity variation amplitude ω with the preset angle threshold, if the angular velocity variation amplitude ω is greater than the angle threshold, it indicates that the self-moving device has a large body ups and downs motion, which is different from the signal when a normal collision occurs, so it can be determined that the self-moving device is in an obstacle crossing state. On the contrary, when the angular velocity variation amplitude ω is less than the angle threshold, it indicates that the self-moving device is in a normal working state. At this time, it is more accurate and reliable to judge whether a collision occurs and calculate the position and strength of the collision through the signal of the pressure sensor 4.
[0097] In step S3, before calculating the collision position, preferably, refer to Figure 3 First, check whether the vibration signal detected by the pressure sensor 4 reaches the trigger threshold V trigger , if the trigger threshold V is reached trigger , the detection signal of the pressure sensor 4 is collected and the collision position is calculated based on the detection signal of the pressure sensor 4. By comparing with the preset trigger threshold to determine whether it is a collision action, interference signals can be eliminated, further improving the accuracy of collision detection. In the figure, ADC refers to the value collected by the analog-to-digital converter. The signal of the pressure sensor 4 is converted into a digital signal by the analog-to-digital converter and then transmitted to the processor (chip). When its value is greater than the trigger threshold V trigger When the chip collects data from the pressure sensor 4 for calculation.
[0098] The present invention also proposes a self-moving device, which can execute the self-moving device collision position detection method described above.
[0099] like Figure 4 and Figure 5 As shown, a self-moving device corresponding to a preferred embodiment of the present invention includes a main body 1, a shell 2 arranged outside the main body 1, a walking mechanism 3 for driving the main body 1 to move, a pressure sensor 4 connected to the shell 2, an inertial sensor 7 connected to the main body 1, and a controller 5 arranged in the main body 1.
[0100] The main body 1 is the main body of the self-moving device, which is provided with components for performing corresponding operations. Taking a sweeping robot as an example, a vacuum pump and a dust box are often provided in the main body 1. The vacuum pump is used to suck the dirt on the ground into the dust box to clean the ground.
[0101] The walking mechanism 3 is connected to the main body 1, and generally includes rollers in contact with the ground and a motor connected to the rollers. The motor drives the rollers to rotate, so that the self-moving device can move on the ground and perform cleaning operations in different areas. Generally, the rollers of the walking mechanism 3 can be divided into guide wheels and drive wheels. The guide wheels mainly play a guiding role, while the drive wheels are mainly used to drive the main body 1 to move.
[0102] like Figure 6 As shown, the body 1 is provided with a top surface 10 , a bottom surface 11 , and an outer side surface 12 connected between the top surface 10 and the bottom surface 11 . Figure 6 The main body 1 shown in the figure is in the shape of an oblate cylinder, and its outer side surface 12 is a toroidal surface. In other embodiments, the shape of the main body 1 is not limited thereto, and may be, for example, a rectangular parallelepiped or other shapes.
[0103] The housing 2 is disposed around the outer peripheral surface 12 of the body 1 and is located at the outermost part of the self-moving device. During the movement of the self-moving device, it will first collide with an object in the external environment. Therefore, the housing 2 can protect the internal body 1. At the same time, the pressure sensor 4 is connected to the housing 2. When the housing 2 collides, the housing 2 will be slightly deformed, which can be sensed by the pressure sensor 4 and generate a sensing signal, which is the signal detected by the pressure sensor 4 (detection signal).
[0104] The housing 2 will vibrate and deform when it collides, and the vibration signal can be transmitted along the housing 2 to the pressure sensor 4, so that the pressure sensor 4 also undergoes slight vibration deformation, thereby generating a series of induction signals of varying sizes. As a preferred embodiment, the pressure sensor 4 is a piezoelectric ceramic sensor, which has a pressure effect and generates an electrical signal after deformation. Therefore, when the housing 2 collides, the pressure sensor 4 can generate an induction signal under the excitation of the vibration signal. The piezoelectric ceramic sensor can be attached to the housing 2 in the form of a patch, which is very convenient to install, for example, attached to the inner or outer surface of the housing 2. Preferably, the piezoelectric ceramic sensor is attached to the inner surface of the housing 2 so that it will not directly collide with other objects, can be protected by the housing 2, and has higher reliability.
[0105] There are at least two pressure sensors 4, and the two pressure sensors 4 are respectively arranged at different positions on the outer circumference or inner circumference of the housing 2. The position information of the pressure sensors 4 is stored in the controller 5 in advance and is a known parameter. When a collision occurs, the two pressure sensors 4 will sense the collision respectively, and then generate sensing signals of different sizes. The pressure sensor 4 is electrically connected to the controller 5, and can transmit the sensing signal to the controller 5, and the controller 5 analyzes and processes the signal. The specific position of the collision can be determined based on the sensing signal of the pressure sensor 4, and the strength of the collision can be determined based on the value of the sensing signal generated by the pressure sensor 4.
[0106] The inertial sensor 7 is used to detect the acceleration information and angular velocity information of the self-moving device. It is preferably a 6-axis inertial sensor that can detect the acceleration of the three axes of x, y, and z and the angular velocity of the three axes of x, y, and z. The inertial sensor 7 is connected to the controller 5 for communication and can transmit the detected data to the controller 5, which analyzes and processes the data to determine the obstacle crossing state and the normal state.
[0107] The controller 5 is the electrical control part of the mobile device. Figure 7As shown, the controller 5 is communicatively connected with the pressure sensor 4 and the inertial sensor 7, and can receive the sensing signals transmitted by the pressure sensor 4 and the inertial sensor 7, analyze and process the sensing signals, and perform state judgment and collision position and force calculation.
[0108] The processor 54 is preferably a single chip microcomputer, which can perform calculations and analysis on the received sensor signals and derive control instructions.
[0109] During the operation of the self-moving device, the controller 5 receives the acceleration information and angular velocity information transmitted by the inertial sensor 7, and calculates the vibration intensity according to the acceleration information. When the vibration intensity is greater than the preset vibration intensity threshold, it calculates the angular velocity change amplitude according to the angular velocity information. If the angular velocity change amplitude is greater than the preset angle threshold, it is determined to be in the obstacle crossing state. On the contrary, if the vibration intensity is less than the preset vibration intensity threshold, or if the angular velocity change amplitude is less than the preset angle threshold, it is determined to be not in the obstacle crossing state.
[0110] The specific calculation method of vibration intensity and angular velocity change amplitude can be referred to above.
[0111] refer to Figure 8 The controller 5 includes two circuits connected between the pressure sensor 4 and the processor 54, the two circuits are respectively a first circuit and a second circuit, and the processor 54 can collect the vibration signal transmitted from the corresponding circuit according to whether the mobile device is in a normal state or an obstacle crossing state.
[0112] Specifically, the first circuit corresponds to a normal state. When it is detected that the self-moving device is in a normal state, the processor 54 collects the vibration signal transmitted by the circuit. The first circuit includes a first low-pass filter 51, a first signal amplifier 52 and a first analog-to-digital converter 53 (i.e., the first A / D converter in the figure) which are electrically connected in sequence. The signal collected by the pressure sensor 4 is low-pass filtered by the first low-pass filter 51, amplified by the first signal amplifier 52, and then converted into a digital signal by the first analog-to-digital converter 53 and input into the processor 54. The cutoff frequency of the first low-pass filter 51 is the first cutoff frequency. Preferably, the first cutoff frequency is less than or equal to 2KHz. Further preferably, the first signal amplifier 52 is a voltage amplifier.
[0113] The second circuit corresponds to the obstacle crossing state. When it is detected that the self-moving device is in the obstacle crossing state, the processor 54 collects the vibration signal transmitted by the circuit. The second circuit includes a second low-pass filter 57, a second signal amplifier 58 and a second analog-to-digital converter 59 (i.e., the second A / D converter in the figure) electrically connected in sequence. The signal collected by the pressure sensor 4 is low-pass filtered by the second low-pass filter 57, amplified by the second signal amplifier 58, and then converted into a digital signal by the second analog-to-digital converter 59 and input into the processor 54. The cutoff frequency of the second low-pass filter 57 is the second cutoff frequency. Preferably, the second cutoff frequency is less than or equal to 80Hz. The amplification factor of the second signal amplifier 58 is greater than the amplification factor of the first signal amplifier 52. Preferably, the first signal amplifier 52 is a voltage amplifier.
[0114] The controller 5 also includes a memory 55, in which preset parameters or programs are stored, and the preset parameters include a vibration intensity threshold, an angle threshold, a trigger threshold, etc. The memory 55 can also store information such as the calculated collision position coordinates and collision strength.
[0115] When it is necessary to collect the detection signal of the pressure sensor 4 to calculate the collision position, the processor 54 first determines whether the collected signal is greater than the trigger signal V trigger , when greater than the trigger signal V trigger When the collision occurs, the signal is collected in real time to calculate the collision position and collision force, and it is judged as a collision action. The processor 54 can store the collision position and force, and perform force calibration. The collision position information and collision force information can be reported to the main system, and the main system controls the walking mechanism to turn to avoid the collision.
[0116] In the present invention, the collision position of the self-moving device is determined based on the signals detected by at least two pressure sensors 4 .
[0117] like Fig. 9 As shown, Fig. 9 The housing 2 shown is provided with two pressure sensors 4. For the convenience of description, the two pressure sensors 4 are respectively referred to as the first pressure sensor 4a and the second pressure sensor 4b, wherein the first pressure sensor 4a is located at A and the second pressure sensor 4b is located at B. The position information of the first pressure sensor 4a and the second pressure sensor 4b on the housing 2 is known (for example, stored in the controller 5 in the form of coordinates), and the transmission distance between the two is also known. The transmission distance refers to the distance that the vibration signal is transmitted from the collision position C along the physical part of the housing 2 to the pressure sensor 4. When the housing 2 is annular, the transmission distance is roughly the arc length between the two points, for example, the transmission distance L between A and B. AB is the arc length of AB, the transmission distance L between the collision position C and A ACis the arc length of AC, and the transmission distance L at the collision position C and B BC is the arc length of BC.
[0118] The vibration signal propagates at a speed V in the housing 2. In the same medium, the speed V is constant. When a collision occurs, the vibration signal will be transmitted to the first pressure sensor 4a and the second pressure sensor 4b. The time it takes to transmit to the two pressure sensors 4 is related to the distance between the collision position and the two pressure sensors 4. The longer the distance, the longer the corresponding time. The time for the pressure sensor 4 to generate the sensing signal after deformation is basically the same. Therefore, the time difference Δt between the sensing signals received by the controller 5 from the two pressure sensors 4 is consistent with the time difference between the two pressure sensors 4a receiving the vibration signal.
[0119] like Fig.10 As shown, Fig.10 The spectrum diagram of the sensing signals generated by the two pressure sensors 4 after the collision occurs is shown. The time difference Δt can be obtained on the spectrum diagram. Specifically, the spectrum diagram shows the first sensing signal 400 generated by the first pressure sensor 4a and the second sensing signal 401 generated by the second pressure sensor 4a. The first sensing signal 400 and the second sensing signal 401 have an obvious receiving order. The sensing signal generated by the pressure sensor 4 closer to the collision position will appear on the spectrum diagram earlier. In the figure, the controller 5 receives the first sensing signal 400 at the first time t1 and the second sensing signal 401 at the second time t2. The interval between the two sensing signals is the time difference Δt.
[0120] The transmission distance L from the collision position C to the pressure sensor 4 can be calculated by the following formula:
[0121]
[0122] Here, Δt is the time difference between the received vibration signal of the pressure sensor 4 and the vibration signal of another pressure sensor 4 .
[0123] Specifically, the transmission distance L from the collision position C to the first pressure sensor 4a is AC It can be calculated by the following formula:
[0124]
[0125] The transmission distance L from the collision position C to the second pressure sensor 4b BC It can be calculated by the following formula:
[0126]
[0127] The shape parameters of the housing 2 are known, and its contour information is preset in the controller 5. The controller 5 can obtain the coordinates of the collision position C according to the calculated transmission distance, the position information of the pressure sensor 4 corresponding to the transmission distance, and the contour information of the housing 2. For example, when the housing 2 is in the shape of a ring, after calculating the transmission distance, the central angle between the collision position and the pressure sensor 4 can be calculated through contour information such as the radius of the housing 2, and then the polar coordinates of the collision position C can be obtained; for another example, when the housing 2 is in the shape of a rectangle, the rectangular coordinates of the collision position C can be calculated through contour information such as the length and width of the housing 2 or the contour coordinates of the housing 2.
[0128] Obviously, we only need to calculate L AC and L BC One of them is to calculate the coordinates of the collision position. In some embodiments, by calculating L AC and L BC , two collision position coordinates can be calculated based on the two, and then the two coordinates can be averaged to obtain a more accurate coordinate position.
[0129] It can be understood that, for the closed ring-shaped housing 2, there are two situations for the transmission distance between A and B, such as Fig. 9 As shown, the collision position may be located at the first side 402 of the line 404 connecting the two pressure sensors 4 (i.e., the AB line), such as point C of the housing 2. At this time, the vibration signal propagates along the housing 2 on the first side 402 of the AB line 404. The transmission distance L between AB AB is L in the figure AB1 The collision position may also be located on the second side 403 of the AB line 404, such as point C' of the housing 2. At this time, the vibration signal propagates along the second side 403 of the AB line 404 of the housing 2, and the transmission distance L between AB AB is L in the figure AB2 Therefore, L in the above formula AB Maybe L AB1 or L AB2 The collision position can be determined to be located on the first side 402 or the second side 403 of the AB line 404 according to the direction of the vibration signal transmitted to the pressure sensor 4, the moving route of the mobile device, or the surrounding environment scanned by a camera, radar, etc., and then the corresponding L can be selected. AB1 or L AB2 Perform calculations.
[0130] Obviously, when the housing 2 is symmetrical about the line AB 404, L AB1 and L AB2 The values of are the same and can be calculated with the same fixed value.
[0131] In order to more conveniently determine the collision position, the number of pressure sensors 4 is 3 or more, so that the collision position can be determined by other pressure sensors 4 (for example Fig.11 and Fig.12 The third pressure sensor 4c in the figure is used to determine the side where the collision occurs, for example, according to the strength of the sensing signal or the time when the sensing signal is obtained. For example, when the collision occurs on the housing 2 between the second pressure sensor 4b and the third pressure sensor 4c, the time of the signal generated by the second pressure sensor 4b and the third pressure sensor 4c is earlier than the time of the signal generated by the first pressure sensor 4a, and the strength is usually greater than the strength of the signal generated by the first pressure sensor 4a, so that the area where the collision sound occurs can be determined. Fig.12 In the embodiment, the third pressure sensor 4c is arranged at the middle position of the AB arc segment.
[0132] As a preferred embodiment, the number of pressure sensors 4 is three or more. In this case, two pressure sensors 4 can be used as a group to calculate the coordinates of multiple collision positions, and then the average value of these coordinates is used as the final collision position coordinate, which is more accurate.
[0133] In a preferred embodiment, the housing 2 is in a closed ring shape, and the housing 2 is integrally formed to form a continuous ring-shaped shell structure, so that the position accuracy of the pressure sensor 4 is higher, the transmission speed of the vibration signal in the housing 2 is more consistent, and it is easier to ensure the accuracy of the calculated collision position coordinates. In this embodiment, the collision position can be detected by a complete ring-shaped housing 2 and at least two pressure sensors 4, which is lower in cost and can achieve 360° all-round collision position detection.
[0134] In another preferred embodiment, Fig.13 As shown, the housing 2 includes a plurality of sub-housings 20, which are arranged around the outside of the body 1. The ends of two adjacent sub-housings 20 can be fitted or have a certain spacing. At least two pressure sensors 4 are arranged on each sub-housing 20 to facilitate calculation of the collision position. Since the vibration can be rapidly attenuated between two adjacent sub-housings 20, it is convenient to determine which sub-housing 20 the collision occurred on according to the strength of the sensing signal, which is more convenient for calculating the collision position. Preferably, at least the two ends of the sub-housing 20 are provided with pressure sensors 4. In this embodiment, 360° all-round detection of the collision position can also be achieved.
[0135] Since the main body 1 has complex structures and components, after a collision occurs, the signal transmitted to the pressure sensor 4 through the main body 1 will be greatly attenuated due to refraction and reflection, and because of the increase in the transmission path, the vibration signal transmitted by the main body 1 will lag behind the vibration signal transmitted by the shell 2. The interference signal can be easily excluded from the spectrum diagram and the effective sensing signal can be identified for calculation.
[0136] Further, in order to better identify the sensing signal, refer to Figure 4 and Figure 5 A buffer layer 6 is provided between the shell 2 and the body 1, and the buffer layer 6 is preferably rubber. The provision of the buffer layer 6, on the one hand, can greatly attenuate the signal transmitted from the shell 2 to the body 1, facilitate the identification of the effective signal by the processor 54, reduce the complexity of the algorithm, improve the calculation speed of the system and the accuracy of the calculated collision position, and help improve the detection accuracy of the collision of soft and light objects. On the other hand, it can play a buffering role and better protect the body 1. The buffer layer 6 can be a complete ring or a plurality of buffers arranged at intervals.
[0137] The self-moving device of the present invention is provided with a shell located outside the main body and a pressure sensor connected to the shell. After the shell collides, the pressure sensor can generate a sensing signal, and then the position where the collision occurred can be calculated based on the sensing signal. The structure is simple and the coordinates of the collision position can be easily obtained. The calculated position has high accuracy, so that the self-moving device can better plan the path and avoid obstacles.
[0138] As a preferred embodiment, refer to Fig.14 In combination with the above-mentioned self-moving device, the calculation of the collision position according to the filtered detection signal in step S3 above includes the following steps:
[0139] S30. Acquire detection signals of the first pressure sensor 4a and the second pressure sensor 4b;
[0140] S31. Calculate the transmission distance of the collision position from the first pressure sensor 4a or the second pressure sensor 4b according to the acquired detection signals of the first pressure sensor 4a and the second pressure sensor 4b;
[0141] S32 . Obtain the coordinates of the collision position according to the calculated transmission distance between the collision position and the first pressure sensor 4 a or the second pressure sensor 4 b , the position information of the first pressure sensor 4 a or the second pressure sensor 4 b , and the contour information of the housing 2 .
[0142] In the above step S30, after the collision occurs, the vibration signal is transmitted from the collision position to the two pressure sensors 4, so that the two pressure sensors 4 generate sensing signals (i.e., detection signals), which are received by the controller 5. Obviously, the detection signal is a signal after low-pass filtering, for example, a signal transmitted to the processor 54 after low-pass filtering through the first circuit or the second circuit described above.
[0143] In the above step S31, the controller 5 calculates the transmission distance from the collision position to the first pressure sensor 4a and / or the second pressure sensor 4b according to the time of the acquired sensing signals of the first pressure sensor 4a and the second pressure sensor 4b and the propagation speed V of the vibration signal in the housing 2.
[0144] In the above step S31, the transmission distance between the collision position and the first pressure sensor 4a or the second pressure sensor 4b needs to be calculated in combination with the transmission distance between the first pressure sensor 4a and the second pressure sensor 4b. Specifically, the transmission distance L between the collision position and the first pressure sensor 4a is AC It can be calculated by the following formula:
[0145]
[0146] The transmission distance from the collision position to the second pressure sensor 4b can be calculated by the following formula:
[0147]
[0148] Where, L AB is the transmission distance between the first pressure sensor 4a and the second pressure sensor 4b, t1 is the time when the vibration signal of the first pressure sensor 4a is obtained; and t2 is the time when the vibration signal of the second pressure sensor 4b is obtained.
[0149] As mentioned above, for the closed annular housing 2, the transmission distance L AB Possibly L AB1 or L AB2 Therefore, the following steps are also included between step S30 and step S31:
[0150] Determine whether the collision position is located at the first side 402 or the second side 403 of the line connecting the first pressure sensor 4a and the second pressure sensor 4b, and then determine the transmission distance L between the first pressure sensor 4a and the second pressure sensor 4b AB Specifically, when the collision position is located at the first side 402, the transfer distance L AB For L AB1 , when the collision position is located at the second side 403, the transmission distance L AB For LAB2 The collision position can be determined to be located on the first side 402 or the second side 403 of the AB line 404 according to the direction of the vibration signal transmitted to the pressure sensor 4, the moving route of the mobile device, or the surrounding environment scanned by a camera, radar, etc., and then the corresponding L can be selected. AB1 or L AB2 Perform calculations.
[0151] When the transmission distance L from the collision position to the pressure sensor 4 is calculated AC After that, the coordinate information of the collision position can be calculated based on the position information of the first pressure sensor 4a and the contour information of the housing 2. Similarly, when the transmission distance L between the collision position and the second pressure sensor 4b is calculated, BC After that, the coordinate information of the collision position can be calculated according to the position information of the second pressure sensor 4b and the contour information of the housing 2.
[0152] As a preferred implementation, in step S32, the force of the collision is calculated based on the amplitudes of the sensing signals of the first pressure sensor 4a and the second pressure sensor 4b at the same time.
[0153] When the number of pressure sensors 4 is three or more, two pressure sensors 4 can be regarded as a group, that is, the self-mobile device includes multiple groups of pressure sensors 4, and each group of pressure sensors 4 includes two pressure sensors 4: a first pressure sensor 4a and a second pressure sensor 4b. In order to improve the accuracy of the calculation result, the following steps are further provided after step S32:
[0154] S33. Calculate a plurality of collision position coordinates according to the sensing signals of the plurality of pressure sensors 4, and take the average value of the plurality of collision position coordinates as the final collision position coordinate.
[0155] In step S33, different groups of pressure sensors 4 are selected to perform calculations through the above steps S30 to S32 to obtain multiple collision position coordinates, and then the multiple collision position coordinates are averaged, which can make the final collision position coordinates have a smaller error with the actual collision position coordinates and a higher accuracy.
[0156] The above are only one or more specific embodiments of the present invention, and any other improvements made based on the concept of the present invention are considered to be within the protection scope of the present invention.
Claims
1. A method for detecting collision position of a self-moving device, It is characterized in that The self-moving device comprises at least two pressure sensors (4) for detecting vibration signals and an inertial sensor for detecting acceleration information and angular velocity information; The method for detecting the collision position of a mobile device comprises the following steps: S1. Using the acceleration information and the angular velocity information to determine whether the self-mobile device is in an obstacle crossing state; S2. If the device is not in the obstacle crossing state, the detection signal of the pressure sensor (4) is subjected to low-pass filtering through a first cutoff frequency; if the device is in the obstacle crossing state, the detection signal of the pressure sensor (4) is subjected to low-pass filtering through a second cutoff frequency, the first cutoff frequency being higher than the second cutoff frequency; S3. Calculate the collision position according to the filtered detection signal; The method of using the acceleration information and the angular velocity information to determine whether the self-moving device is in an obstacle crossing state comprises the following steps: S10. Calculating the vibration intensity according to the acceleration information; S11. If the vibration intensity is greater than the preset vibration intensity threshold, the angular velocity change amplitude is calculated according to the angular velocity information, and if the angular velocity change amplitude is greater than the preset angle threshold, it is determined to be in the obstacle crossing state; if the vibration intensity is less than the preset vibration intensity threshold, or if the angular velocity change amplitude is less than the preset angle threshold, it is determined to be not in the obstacle crossing state; The vibration intensity is calculated based on the acceleration information of the three axes, and the calculation formula is as follows: In the formula, a is the vibration intensity, a xj 、a yj and a zj They refer to the accelerations in the x, y, and z axes collected for the jth time respectively; The angular velocity variation is calculated based on the angular velocity information in the x-axis and y-axis directions, and the calculation formula is as follows: Where ω is the angular velocity change amplitude, ω xj and ω yj are the angular velocities in the x-axis and y-axis directions collected for the jth time, respectively.
2. The method for detecting the collision position of a self-moving device according to claim 1, It is characterized in that The first cut-off frequency is less than or equal to 2 kHz, and the second cut-off frequency is less than or equal to 80 Hz.
3. The method for detecting the collision position of a self-moving device according to claim 1 or 2, It is characterized in that In step S2, the detection signal of the pressure sensor (4) is transmitted to the processor after low-pass filtering, signal amplification and analog-to-digital conversion; Furthermore, the signal amplification factor when in the obstacle crossing state is greater than the signal amplification factor when not in the obstacle crossing state.
4. The method for detecting the collision position of a self-moving device as claimed in claim 3, It is characterized in that The signal amplification factor when in the obstacle crossing state is greater than or equal to 3 times the signal amplification factor when not in the obstacle crossing state.
5. The method for detecting the collision position of a self-moving device according to claim 1 or 2, It is characterized in that In step S3, before calculating the collision position, it is first detected whether the vibration signal detected by the pressure sensor (4) reaches a trigger threshold; if the trigger threshold is reached, the detection signal of the pressure sensor (4) is collected and the collision position is calculated based on the detection signal of the pressure sensor (4).
6. The method for detecting the collision position of a self-moving device according to claim 1 or 2, It is characterized in that The self-moving device comprises a body (1) and a shell (2) surrounding the body (1), wherein at least a first pressure sensor (4a) and a second pressure sensor (4b) are arranged on the shell (2); In step S3, calculating the collision position according to the filtered detection signal includes the following steps: S30. Acquire detection signals of the first pressure sensor (4a) and the second pressure sensor (4b); S31. Calculating the transmission distance of the collision position from the first pressure sensor (4a) or the second pressure sensor (4b) according to the acquired detection signals of the first pressure sensor (4a) and the second pressure sensor (4b); S32. Obtaining the coordinates of the collision position according to the transmission distance between the collision position and the first pressure sensor (4a) or the second pressure sensor (4b), the position information of the first pressure sensor (4a) or the second pressure sensor (4b), and the contour information of the housing (2).
7. The method for detecting the collision position of a self-moving device according to claim 6, It is characterized in that In the step S31, the transmission distance between the collision position and the first pressure sensor (4a) or the second pressure sensor (4b) is calculated in combination with the transmission distance between the first pressure sensor (4a) and the second pressure sensor (4b).
8. The method for detecting the collision position of a self-moving device as claimed in claim 7, It is characterized in that The housing (2) is a continuous annular shell structure, and the following steps are also included before step S31: It is determined whether the collision position is located on the first side (402) or the second side (403) of the line connecting the first pressure sensor (4a) and the second pressure sensor (4b), thereby determining the value of the transmission distance between the first pressure sensor (4a) and the second pressure sensor (4b).
9. The method for detecting collision position of a self-moving device according to claim 1 or 2, It is characterized in that In step S3, the collision force is also calculated according to the amplitude of the filtered detection signal.
10. A self-propelled device, It is characterized in that include: Ontology(1); A housing (2) arranged around the outer side surface (12) of the body (1); at least two pressure sensors (4), the pressure sensors (4) being connected to the housing (2); An inertial sensor (7) is used to detect acceleration information of the self-moving device in three axes and angular velocity information in X and Y axes; A controller (5) is connected to the pressure sensor (4) and the inertial sensor (7) for communication, and the controller (5) determines whether the self-moving device is in an obstacle crossing state according to the acceleration information and the angular velocity information; If the vehicle is not in the obstacle crossing state, the detection signal of the pressure sensor (4) is low-pass filtered through a first cutoff frequency, and the collision position is calculated based on the filtered detection signal; If in an obstacle crossing state, a detection signal of the pressure sensor (4) is low-pass filtered through a second cutoff frequency, and a collision position is calculated based on the filtered detection signal, the first cutoff frequency being higher than the second cutoff frequency; The step of judging whether the self-moving device is in an obstacle crossing state according to the acceleration information and the angular velocity information comprises the following steps: S10. Calculating the vibration intensity according to the acceleration information; S11. If the vibration intensity is greater than the preset vibration intensity threshold, the angular velocity change amplitude is calculated according to the angular velocity information, and if the angular velocity change amplitude is greater than the preset angle threshold, it is determined to be in the obstacle crossing state; if the vibration intensity is less than the preset vibration intensity threshold, or if the angular velocity change amplitude is less than the preset angle threshold, it is determined to be not in the obstacle crossing state; The vibration intensity is calculated based on the acceleration information of the three axes, and the calculation formula is as follows: In the formula, a is the vibration intensity, a xj 、a yj and a zj They refer to the accelerations in the x, y, and z axes collected for the jth time respectively; The angular velocity variation is calculated based on the angular velocity information in the x-axis and y-axis directions, and the calculation formula is as follows: Where ω is the angular velocity change amplitude, ω xj and ω yj are the angular velocities in the x-axis and y-axis directions collected for the jth time, respectively.
11. The self-moving device according to claim 10, It is characterized in that The first cut-off frequency is less than or equal to 2 kHz, and the second cut-off frequency is less than or equal to 80 Hz.
12. The self-moving device according to claim 10 or 11, It is characterized in that The controller (5) comprises a processor (54) and a first circuit and a second circuit connected between the pressure sensor (4) and the processor (54); The first circuit comprises a first low-pass filter (51), a first signal amplifier (52) and a first analog-to-digital converter (53) which are electrically connected in sequence, and the cut-off frequency of the first low-pass filter (51) is a first cut-off frequency; The second circuit comprises a second low-pass filter (57), a second signal amplifier (58) and a second analog-to-digital converter (59) which are electrically connected in sequence, the cut-off frequency of the second low-pass filter (57) being a second cut-off frequency, and the amplification factor of the second signal amplifier (58) being greater than or equal to 3 times the amplification factor of the first signal amplifier (52).
