Regression control method, automatic walking device and automatic walking system
Determining whether the automatic walking device is at the boundary line of the isolation area by detecting the marking signal, the problems of misjudgment and low efficiency in the prior art are solved, and more accurate and efficient regression control is achieved.
Patent Information
- Application Number
- CN202011570672.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-12-26
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2040-12-26
AI Technical Summary
In the regression mode, existing automatic walking equipment is prone to misjudgment of the obstacle boundary line as a regression route, resulting in continuous detours. The existing solutions require the determination of predetermined values, which are prone to failure due to terrain changes, resulting in misjudgment and low efficiency. .
By detecting a marking signal, such as a magnetic signal, it is determined whether the automatic walking device is on the boundary line of the isolation area and breaks away from the boundary line when the signal is detected, and refining the regression boundary line.
The accuracy of regression control is improved, the failure and misjudgment of predetermined values caused by terrain is avoided, and the regression efficiency of automatic walking equipment is improved.
Smart Images

Figure CN114756014B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of automation control technology, and in particular to a regression control method, an automatic walking device and an automatic walking system. Background Art
[0002] With the continuous development of science and technology, automatic walking devices such as sweeping robots and lawn mowers are becoming well-known. These automatic walking devices greatly save people's time and bring convenience to people's work and life. The function of automatic walking devices to automatically return to find charging devices has become a standard function, which improves the working efficiency of automatic walking devices.
[0003] Generally, when the automatic walking device enters the regression mode, it will move along the preset boundary line to the charging device set on the boundary line. During the movement, the automatic walking device continuously detects the boundary signal generated on the boundary line, and then identifies the boundary position and walks along the boundary position. However, in actual applications, there may be some obstacles in the working area defined by the boundary line, such as vegetation and pools in the garden. In order to avoid these obstacles and reduce collisions, the existing solution is to lay a circle of wires around the obstacles as a boundary line for defining the isolation area. This solution has the following defects: when the automatic walking device is returning, once it encounters the boundary line that defines the isolation area, it often uses the boundary line as the regression route, causing the automatic walking device to continue to walk around the boundary line.
[0004] In response to the above problems, the existing solution is to determine a predetermined value. When the displacement difference between the two driving wheels of the automatic walking device is greater than the predetermined value, the driving wheel is controlled to detach from the current wire. At the same time, a time amount can also be predetermined. When the moving time exceeds the predetermined value, the driving wheel is controlled to detach from the current wire. Or it can be an angle amount. When the angle change obtained during the movement of the automatic walking device exceeds the predetermined value, the driving wheel is controlled to detach from the current wire. The above schemes all need to determine a predetermined value. On the one hand, the determination of the predetermined value needs to take into account the actual situation, such as the time amount. If the automatic walking device encounters a slope during walking, changes the walking direction or stops moving, the predetermined value will be invalid and the judgment will be biased. On the other hand, when the boundary line is more complicated to bypass special obstacles, the existing schemes mentioned above also have the problem of inaccurate judgment and misjudgment. Summary of the invention
[0005] Based on this, it is necessary to provide a regression control method, an automatic walking device, an automatic walking system and a computer-readable storage medium that can accurately identify different boundary lines in response to the above technical problems.
[0006] A regression control method is applied to an automatic walking device, the method comprising:
[0007] When it is determined that the automatic walking device has returned, detecting a marking signal;
[0008] Determining whether the autonomous vehicle is on a boundary line of an isolation area according to a detection result of the marking signal;
[0009] When the autonomous vehicle is on the boundary line of the isolation area, it moves away from the boundary line of the isolation area and searches for a return boundary line again;
[0010] Wherein, the isolation area boundary line is used to mark obstacles.
[0011] In one embodiment, when it is determined that the autonomous walking device has returned, the step of detecting a marking signal includes:
[0012] When it is determined that the automatic walking device has returned, detecting whether a magnetic signal is received; the magnetic signal is generated by a magnetic component, and the distance between the magnetic component and the boundary line of the isolation area is less than or equal to a preset value;
[0013] The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area according to the detection result of the marking signal comprises:
[0014] If a magnetic signal is detected, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
[0015] In one embodiment, when it is determined that the autonomous walking device has returned, the step of detecting a marking signal comprises:
[0016] When the autonomous walking device returns and it is detected for the first time that the autonomous walking device rides on the line, the current position of the autonomous walking device is defined as a reference position;
[0017] Based on the reference position, determining the real-time coordinates of the automatic walking device;
[0018] The step of determining whether the autonomous vehicle is located on a boundary line of an isolation area according to the detection result of the marking signal comprises:
[0019] Based on the reference position and the real-time coordinates, it is determined whether the autonomous driving device is located on the boundary line of the isolation area.
[0020] In one embodiment, the step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates includes:
[0021] Determine the distance change trend between each of the real-time coordinates and the reference position;
[0022] According to the distance change trend, it is determined whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
[0023] In one embodiment, the step of determining whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area according to the distance change trend includes:
[0024] When the distance between the real-time coordinates and the reference position shows a decreasing trend, determining whether the distance between the current coordinates of the automatic walking device and the reference position is less than the walking distance of the automatic walking device in one sampling period;
[0025] If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
[0026] In one embodiment, the step of determining the distance change trend between each of the real-time coordinates and the reference position comprises:
[0027] Determine a critical coordinate according to the distance between each of the real-time coordinates and the reference position, wherein the critical coordinate is the coordinate farthest from the reference position;
[0028] When the critical coordinate remains unchanged, a distance change trend between the real-time coordinate sampled after the critical coordinate and the reference position is determined.
[0029] In one embodiment, the step of determining whether the current boundary line of the automatic walking device is the boundary line of the isolation area according to the distance change trend includes:
[0030] When the distance between each of the real-time coordinates sampled after the critical coordinate and the reference position shows an increasing trend, determining whether the distance between each of the real-time coordinates sampled after the critical coordinate and the critical coordinate shows a decreasing trend;
[0031] If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
[0032] In one embodiment, the step of determining the critical coordinates according to the distance between each of the real-time coordinates and the reference position comprises:
[0033] Determining whether the displacement angle change of the automatic walking device reaches a preset value;
[0034] If so, the critical coordinates are determined according to the distance between each of the real-time coordinates and the reference position.
[0035] In one embodiment, the step of determining whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area according to the distance change trend includes:
[0036] When the distance between the real-time coordinates and the reference position is continuously less than a preset threshold for a preset time period, or when the distance between the real-time coordinates and the reference position is first greater than a preset threshold and then less than or equal to a preset threshold, it is determined that the current boundary line of the automatic walking device is the boundary line of the isolation area.
[0037] In one embodiment, the step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates includes:
[0038] When the distance between the real-time coordinate and the reference position is less than or equal to the body length of the autonomous driving device, it is determined that the boundary line where the autonomous driving device is currently located is the boundary line of the isolation area.
[0039] In one of the embodiments, the step of determining the real-time coordinates of the autonomous walking device based on the reference position further includes: determining the quadrant of the first real-time coordinate obtained;
[0040] The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates comprises:
[0041] When the distance between the real-time coordinate and the reference position is less than or equal to the fuselage length of the automatic walking device, determining whether the displacement angle change of the automatic walking device reaches a preset value;
[0042] If so, determine the quadrant of the current coordinates;
[0043] Determining whether the quadrant of the current coordinates is consistent with the quadrant of the first real-time coordinates;
[0044] If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
[0045] In one of the embodiments, the step of determining the real-time coordinates of the automatic walking device based on the reference position includes: acquiring the real-time coordinates of the automatic walking device relative to the reference position according to a preset sampling period.
[0046] In one embodiment, the step of acquiring the real-time coordinates of the autonomous walking device relative to the reference position according to a preset sampling period includes:
[0047] Acquire an initial angle when the automatic walking device is located at the reference position;
[0048] Acquire the coordinates of the first sampling position according to the displacement angle change of the first sampling position relative to the reference position and the straight-line distance between the reference position and the first sampling position;
[0049] Obtain the displacement angle change of the Nth sampling position relative to the reference position, the straight-line distance between the Nth sampling position and the N-1th sampling position, and the coordinates of the N-1th sampling position, and obtain the coordinates of the Nth sampling position, where N is a natural number greater than or equal to 2.
[0050] In one embodiment, the automatic walking device includes a walking roller and a driving motor for driving the walking roller to walk, the driving motor is connected to a driving pulse feedback unit, and the automatic walking device also includes a gyroscope;
[0051] In the step of acquiring the real-time coordinates of the autonomous walking device relative to the reference position according to a preset sampling period,
[0052] Acquiring the initial angle and the displacement angle change by the gyroscope;
[0053] The number of pulses generated when the driving motor rotates is obtained through the driving pulse feedback unit, and the straight-line distance is determined according to the number of pulses.
[0054] An automatic walking device, comprising:
[0055] A detection module, used for detecting a marking signal when it is determined that the automatic walking device has returned;
[0056] A determination module, used to determine whether the autonomous walking device is on a boundary line of an isolation area according to a detection result of the marking signal, wherein the boundary line of the isolation area is used to mark an obstacle;
[0057] The control module is used to control the automatic walking device to leave the boundary line of the isolation area when the automatic walking device is on the boundary line of the isolation area, and to find the regression boundary line again.
[0058] In one of the embodiments, the detection module is used to detect whether a magnetic signal is received when it is determined that the automatic walking device is returning;
[0059] The determination module is used to determine that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area if a magnetic signal is detected;
[0060] Wherein, the magnetic signal is generated by a magnetic component, and the distance between the magnetic component and the boundary line of the isolation area is less than or equal to a preset value.
[0061] In one of the embodiments, the coverage width of the magnetic signal generated by the magnetic member is greater than half of the width of the fuselage and less than the width of the fuselage.
[0062] In one embodiment, the magnetic member includes a magnet, and the detection module includes a Hall sensor or a proximity sensor.
[0063] In one embodiment, the detection module includes:
[0064] A reference position determination unit, used for defining the current position of the automatic walking device as a reference position when the automatic walking device returns and the automatic walking device is detected to be riding the line for the first time;
[0065] A real-time coordinate determination unit, used to determine the real-time coordinates of the automatic walking device based on the reference position;
[0066] The determination module is used to determine whether the autonomous driving device is located on the boundary line of the isolation area based on the reference position and the real-time coordinates.
[0067] A computer-readable storage medium stores computer instructions, and when the computer instructions are executed by a processor, the above-mentioned regression control method is implemented.
[0068] An automatic walking system comprises the automatic walking device as described above.
[0069] The above-mentioned regression control method detects the marking signal when determining the regression of the automatic walking device, and determines whether the automatic walking device is on the boundary line of the isolation area used to mark the obstacle based on the detection result of the marking signal, and then when the automatic walking device is on the boundary line of the isolation area, controls the automatic walking device to leave the boundary line of the isolation area and re-find the regression boundary line. Compared with the traditional method of judging whether the automatic walking device is walking around the boundary line of the isolation area based on whether the displacement or angle change meets the predetermined value, the above-mentioned method of the present application only needs to be based on the detection result of the marking signal when determining whether the automatic walking device is on the boundary line of the isolation area, thereby avoiding the situation where the predetermined value fails due to terrain reasons and thus causes misjudgment, thereby improving the accuracy of regression control. BRIEF DESCRIPTION OF THE DRAWINGS
[0070] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the conventional technology, the drawings required for use in the embodiments or the conventional technology descriptions are briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0071] Figure 1 and Figure 2 Schematic diagram of application scenarios of the automatic walking device provided for this application;
[0072] Figure 3 A flowchart of the regression control method provided in Example 1 of the present application;
[0073] Figure 4 This is a flowchart of step S100 of the regression control method provided in Example 1 of the present application;
[0074] Figure 5 This is a flowchart of step S300 of the regression control method provided in Example 1 of the present application;
[0075] Figure 6 This is a flowchart of step S320 of the regression control method provided in Example 1 of the present application;
[0076] Figure 7 This is a flowchart of step S310 of the regression control method provided in Example 1 of the present application;
[0077] Figure 8 This is a flowchart of step S320 of the regression control method provided in Example 1 of the present application;
[0078] Fig. 9 A specific example diagram of the boundary line of the isolation area;
[0079] Fig.10 This is a flowchart of step S311 of the regression control method provided in Example 1 of the present application;
[0080] Fig.11 Another specific example diagram of the boundary line of the isolation area;
[0081] Fig.12 This is a flowchart of step S120 of the regression control method provided in Example 1 of the present application;
[0082] Fig.13 A specific example of the coordinate axis established in the regression control method provided in Example 1 of the present application;
[0083] Fig.14 A schematic diagram of the structure of the automatic walking device provided in Example 2 of the present application;
[0084] Fig.15 This is a schematic diagram of the structure of the computer device provided in Example 3 of the present application.
[0085] Description of reference numerals:
[0086] 10. Automatic walking equipment; 20. Boundary line; 201. Magnetic parts; 30. Working area; 40. Isolation area; 50. Stop. DETAILED DESCRIPTION
[0087] 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.
[0088] 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.
[0089] 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.
[0090] It should be noted that when an element is referred to as being "fixed to" 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.
[0091] As described in the background technology, since there may be some obstacles in the working area where the automatic walking device is located, such as vegetation, pools, etc. in the garden, in order to avoid these obstacles, a circle of boundary lines is often set around the obstacles to prevent the automatic walking device from colliding with these obstacles. Then there will be two kinds of boundary lines, one for defining the working area of the automatic walking device, and the other for defining the isolation area (i.e. the area where the obstacle is located). When the automatic walking device enters the regression mode, it detects the boundary signal on the boundary line and then returns to the charging device along the boundary line. However, in this process, the automatic walking device often detects the boundary signal on the boundary line used to define the isolation area, which causes the automatic walking device to continue to walk around the boundary line corresponding to the isolation area and cannot achieve regression.
[0092] In order to solve the above problems, the prior art adopts a method of determining a predetermined value to detect the displacement difference of the two driving wheels of the automatic walking device. When it is greater than the predetermined value, the driving wheels are controlled to leave the current boundary line; or the angle change during the movement of the automatic walking device is detected. When it is greater than the predetermined value, the driving wheels are controlled to leave the current boundary line. Although this solution can identify to a certain extent whether the automatic walking device is currently walking around the boundary line corresponding to the isolation area, this solution has the following defects:
[0093] 1. The predetermined value needs to be determined first. The determination of the predetermined value needs to take into account the actual situation and requires a large amount of test data support, which requires a lot of work to implement;
[0094] 2. If the automatic walking device encounters a slope during walking and changes its walking direction or stops moving, this will make the preset value invalid, and thus cause errors in the final judgment;
[0095] 3. The automatic walking device needs to move at least one circle along the boundary line corresponding to the isolation area to obtain the judgment result, which is inefficient.
[0096] In view of the above-mentioned problems existing in the prior art, the embodiments of the present application provide a regression control method, an automatic walking device, an automatic walking system and a computer-readable storage medium.
[0097] Embodiment 1
[0098] This embodiment provides a regression control method, which is applied to an automatic walking device, wherein the automatic walking device may be a lawn mowing robot, a sweeping robot, or a snow sweeping robot.
[0099] like Figure 1 and Figure 2As shown, the automatic walking device 10 has a working mode and a return mode. When in the working mode, the automatic walking device 10 moves and performs work tasks within the working area 30 defined by the boundary line 20 and outside the isolation area 40; when in the return mode, the automatic walking device 10 moves to the boundary line 20, and moves along the boundary line 20 until it returns to the corresponding docking station 50. Among them, the boundary line 20 defining the isolation area 40 can be independent of the boundary line 20 defining the working area 30, or it can be connected. When connected together, a magnetic field signal is generally not generated in the connection area of the boundary line 20, because the current directions on the two boundary lines 20 are opposite and the distance is close, so there will be a mutual cancellation of magnetic field signals. In this application, the boundary line defining the isolation area (i.e., set around the obstacle) is defined as the isolation area boundary line.
[0100] like Figure 3 As shown, the regression control method provided in this embodiment includes the following steps:
[0101] Step S100: When it is determined that the autonomous driving device has returned, a marking signal is detected.
[0102] Specifically, when it is determined that the autonomous vehicle enters the regression mode, the marker signal is detected. The marker signal can be in various forms, such as an electrical signal or a magnetic signal emitted by a marker element set at a preset position on the boundary line of the isolation area, or a position signal of the autonomous vehicle during the regression walking process, and other types of marker signals are certainly not excluded.
[0103] Step S300: Determine whether the autonomous vehicle is on the boundary line of the isolation area according to the detection result of the marking signal.
[0104] The isolation area boundary line is used to mark the obstacle, that is, a boundary line is laid around the obstacle to divide the area where the obstacle is located into the isolation area, and the boundary line is the isolation area boundary line.
[0105] Assuming that the marking signal is an electric signal or magnetic signal emitted by a marking element set at a preset position of the isolation area boundary line, the positional relationship between the automatic walking device and the isolation area boundary line can be determined through the detection results of the electric signal or magnetic signal, and then whether the automatic walking device is located on the isolation area boundary line can be determined. Assuming that the marking signal is a position signal of the automatic walking device in the regression process, the walking pattern of the automatic walking device can be determined through the detection results of each position signal, and then whether the automatic walking device is on the isolation area boundary line and walks around the isolation area boundary line.
[0106] Step S500: When the autonomous vehicle is on the boundary line of the isolation area, it leaves the boundary line of the isolation area and searches for the return boundary line again.
[0107] When it is determined that the autonomous vehicle is on the boundary line of the isolation area, the autonomous vehicle is controlled to leave the current boundary line of the isolation area and find the return boundary line again, that is, to avoid the problem that the autonomous vehicle regards the boundary line of the isolation area as the return boundary line and cannot return normally.
[0108] When it is determined that the automatic walking device is on the regression boundary line, the current walking track of the automatic walking device is maintained, and the marking signal is continuously detected, so as to subsequently know in real time whether the automatic walking device has walked to the boundary line of the isolation area.
[0109] The above-mentioned regression control method detects the marking signal when determining the regression of the automatic walking device, and determines whether the automatic walking device is on the boundary line of the isolation area used to mark the obstacle based on the detection result of the marking signal, and then when the automatic walking device is on the boundary line of the isolation area, controls the automatic walking device to leave the boundary line of the isolation area and re-find the regression boundary line. Compared with the traditional method of judging whether the automatic walking device is walking around the boundary line of the isolation area based on whether the displacement or angle change meets the predetermined value, the above-mentioned method of the present application only needs to be based on the detection result of the marking signal when determining whether the automatic walking device is on the boundary line of the isolation area, thereby avoiding the situation where the predetermined value fails due to terrain reasons and thus causes misjudgment, thereby improving the accuracy of regression control.
[0110] In one embodiment, step S100, i.e., when determining that the autonomous walking device has returned, the step of detecting the marking signal includes:
[0111] When it is determined that the automatic walking device has returned, it is detected whether a magnetic signal is received; the magnetic signal is generated by the magnetic member 201, and the distance between the magnetic member 201 and the boundary line of the isolation area is less than or equal to a preset value.
[0112] Specifically, refer to Figure 1 , the magnetic part 201 can be arranged on the isolation area boundary line, or it can be arranged at a position within a preset value distance from the isolation area boundary line. The preset value can be determined according to actual needs. For example, the magnetic part is arranged at a position 1cm-5cm away from the isolation area boundary line. The magnetic part can generate a magnetic signal with a certain coverage range. When the automatic walking device walks on the isolation area boundary line (a small deviation can be allowed), the magnetic signal generated by the magnetic part can be detected. Based on this, in this embodiment, when the automatic walking device returns, it is detected whether the magnetic signal is received to determine whether the automatic walking device is at the isolation area boundary line.
[0113] Step S300, i.e., the step of determining whether the autonomous vehicle is located on the boundary line of the isolation area according to the detection result of the marking signal, comprises: if a magnetic signal is detected, determining that the boundary line where the autonomous vehicle is currently located is the boundary line of the isolation area.
[0114] When a magnetic signal is detected, it can be determined that the automatic walking device is walking along the boundary line of the isolation area; if no magnetic signal is detected, it can be determined that the automatic walking device is walking along the normal return boundary line.
[0115] By detecting magnetic signals, the current boundary line of the automatic walking device is judged, and the overall detection efficiency and control efficiency are high, which improves the efficiency of the automatic walking device in identifying the boundary line of the isolation area.
[0116] In this embodiment, when the isolation area boundary line and the regression boundary line are close, the magnetic part can be set at a position far away from the regression boundary line. Specifically, the distance between the magnetic part and the regression boundary line can at least satisfy that the magnetic signal of the magnetic part cannot cover the regression boundary line. This can avoid the situation where the magnetic signal of the magnetic part is misdetected when the automatic walking device is walking and returning normally along the regression boundary line, thereby reducing the detection error rate.
[0117] In one embodiment, the coverage width of the magnetic signal generated by the magnetic component is greater than half the width of the body of the automatic walking device. Since the automatic walking device may deviate from the boundary line when walking along the boundary line, the coverage width of the magnetic signal generated by the magnetic component is set to be greater than half the width of the body, thereby ensuring to a certain extent that the magnetic field signal generated by the magnetic component can be detected and identified even when the automatic walking device has a certain offset from the boundary line.
[0118] In one of the embodiments, the coverage width of the magnetic field signal generated by the magnetic part is smaller than the width of the fuselage. In practical applications, the regression boundary line may be close to the isolation area boundary line. When the automatic walking device is walking on the regression boundary line, it may also misdetect the magnetic field signal generated by the magnetic part on the isolation area boundary line. Based on this problem, in this embodiment, the coverage width of the magnetic field signal generated by the magnetic part is set to be smaller than the width of the fuselage, which can prevent misjudgment caused by the excessively strong magnetic field signal of the magnetic part.
[0119] In practical applications, the coverage width of the magnetic field signal generated by the magnetic component is related to the type or size of the selected magnetic component, and the magnetic component can be selected according to actual needs.
[0120] In this embodiment, the number of magnetic parts is not unique, and can be one or more, such as two, three, or four. When there are multiple magnetic parts, the magnetic parts are respectively set at multiple positions corresponding to the boundary line of the isolation area. As a result, when the automatic walking device walks to multiple positions corresponding to the boundary line of the isolation area, it can detect the magnetic field signal generated by the corresponding magnetic parts, that is, the probability of identifying the boundary line of the isolation area is increased, avoiding the situation where the boundary line of the isolation area is identified only after walking around the boundary line of the isolation area for a long time.
[0121] In one embodiment, the magnetic part may include a magnet, and the magnetic signal generated by the magnet may be detected by a Hall sensor or a proximity sensor arranged on the body of the automatic walking device. The coordinated use of the Hall sensor or the proximity sensor and the magnet is relatively simple to implement, has high detection accuracy, and has low hardware cost.
[0122] In a specific implementation, when the control module detects a magnetic signal, it determines that the current boundary line is the boundary line of the isolation area, and controls the walking module to drive the automatic walking device to leave the current boundary line. At this time, no matter whether there are one or more magnetic parts, when the magnetic signal is detected, it leaves the current boundary line, and there is no need to move a circle to determine whether to walk along the boundary line, which is convenient for rapid return.
[0123] In another specific embodiment, when the detection result of the control module is that a plurality of magnetic signals are detected, the control module determines that the current boundary line is the isolation area boundary line, and controls the walking module to drive the automatic walking device to break away from the current boundary line. At this time, when the magnetic parts are multiple, when multiple magnetic signals are detected, the current boundary line is broken away, and multiple magnetic parts are set. When there is magnetic signal interference, the situation of misjudgment as the isolation area boundary line can be reduced, and it is not necessary to move a circle to determine whether to walk along the boundary line, thereby improving efficiency. That is, in order to prevent misjudgment, the control device can not immediately control the automatic walking device to break away when the magnetic signal is detected for the first time, but control the automatic walking device to break away when the magnetic signal is detected again afterwards, or break away when the magnetic signal is detected for multiple times in a row afterwards. Thus, misjudgment caused by interference from other magnetic signals from the outside world can be avoided.
[0124] In one embodiment, the shortest distance between the magnetic part and the regression boundary line is at least greater than the coverage width of the magnetic field signal generated by the magnetic part. This can prevent the automatic walking device from walking normally on the regression boundary line and detecting the magnetic field signal generated by the magnetic part, thereby avoiding misjudgment.
[0125] In another embodiment, referring to Figure 4 , step S100, that is, when it is determined that the autonomous walking device has returned, the step of detecting the marking signal includes:
[0126] Step S110: When the autonomous walking device returns and it is detected for the first time that the autonomous walking device rides on the line, the current position of the autonomous walking device is defined as the reference position.
[0127] When the automatic walking device is controlled to enter the regression mode, the automatic walking device first searches for the boundary line, and then returns to the line after finding the boundary line. When the automatic walking device is detected to be riding the line for the first time, the current position of the automatic walking device is defined as the reference position. Specifically, the current position of the automatic walking device is taken as the coordinate origin (refer to Figure 2 ) to establish the horizontal and vertical axes.
[0128] Among them, the method for detecting whether the automatic walking device rides the line can be: using boundary detection modules respectively arranged on both sides of the body of the automatic walking device and the boundary detection module in the middle of the body to detect boundary signals in real time, when the boundary signal waveforms detected by the boundary detection modules on both sides are in opposite directions, it is considered that the automatic walking device rides the line. Of course, other methods can also be used to determine whether the automatic walking device rides the line, which will not be repeated here.
[0129] Step S120: Determine the real-time coordinates of the autonomous driving device based on the reference position.
[0130] That is, during the process of the automatic walking device riding the wire, the real-time coordinates of the automatic walking device relative to the reference position (i.e., the coordinate origin) are determined in real time. Specifically, in order to reduce the amount of calculation, a fixed sampling period can be set, and the real-time coordinates of the automatic walking device relative to the reference position are determined every other sampling period.
[0131] Step S300, i.e., the step of determining whether the autonomous vehicle is located on the boundary line of the isolation area according to the detection result of the marking signal, comprises:
[0132] Based on the reference position and the real-time coordinates, determine whether the autonomous driving device is on the boundary line of the isolation area.
[0133] Once the reference position and the real-time coordinates of the automatic walking device relative to the reference position during the regression process are determined, the walking trajectory and trend of the automatic walking device can be predicted based on the reference position and real-time coordinates, thereby determining whether the automatic walking device is on the boundary line of the isolation area.
[0134] The above method of determining whether the automatic walking device is on the boundary line of the isolation area through the reference position and real-time coordinates has higher detection accuracy and lower misjudgment rate.
[0135] In one embodiment, referring to Figure 5 The steps of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates include:
[0136] Step S310: Determine the distance change trend between each real-time coordinate and the reference position.
[0137] Step S320: Determine whether the current boundary line of the autonomous driving device is the boundary line of the isolation area according to the distance change trend.
[0138] That is, the distance between each real-time coordinate and the reference position can be determined first, and then it can be determined whether the change in the distance between each real-time coordinate and the reference position conforms to the preset change trend. If it conforms, the boundary line where the automatic walking device is currently located is determined to be the boundary line of the isolation area. The preset change trend can be determined in advance based on the scene of the automatic walking device walking around the boundary line of the isolation area, and then it can be inferred from the preset change trend whether the device is at the boundary line of the isolation area and walks around the boundary line of the isolation area.
[0139] In one embodiment, referring to Figure 6 Step S320, i.e., the step of determining whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area according to the distance change trend, includes:
[0140] Step S321: When the distance between the real-time coordinates and the reference position shows a decreasing trend, it is determined whether the distance between the current coordinates of the automatic walking device and the reference position is less than the walking distance of the automatic walking device in one sampling period.
[0141] Step S322: If yes, determine that the boundary line where the autonomous driving device is currently located is the boundary line of the isolation area.
[0142] That is, when the distance between the real-time coordinates and the reference position shows a decreasing trend, it means that the automatic walking device is approaching the reference position. At this time, it can be preliminarily determined that the automatic walking device may be walking around a closed boundary line, but it is not ruled out that the terrain causes the automatic walking device to walk along a distorted regression boundary line. In order to prevent misjudgment, it is then determined whether the distance between the current coordinates of the automatic walking device and the reference position is less than the walking distance within a sampling period. If it is less than the walking distance within a sampling period, it is determined that the automatic walking device is very close to the reference position. At this time, it can be considered that the automatic walking device is walking around the boundary line of the isolation area, that is, the boundary line where the automatic walking device is currently located is determined to be the boundary line of the isolation area.
[0143] If the distance between the current coordinates of the automatic walking device and the reference position is greater than or equal to the walking distance of the automatic walking device in one sampling period, the automatic walking device is controlled to continue walking and continuing detection.
[0144] In another embodiment, referring to Figure 7 Step S310, i.e., the step of determining the distance change trend between each real-time coordinate and the reference position, comprises:
[0145] Step S311, determining a critical coordinate according to the distance between each real-time coordinate and the reference position, where the critical coordinate is the coordinate farthest from the reference position.
[0146] Each time a real-time coordinate is obtained by sampling, the distance between the real-time coordinate and the reference position can be determined. According to the distances between several real-time coordinates and the reference position, the coordinate farthest from the reference position can be determined and used as the critical coordinate. The critical coordinate is not fixed. If the distance between the subsequently obtained real-time coordinate and the reference position is greater than the distance between the current critical coordinate and the reference position, the subsequently obtained real-time coordinate will be used as the critical coordinate.
[0147] Among them, the coordinate farthest from the reference position can refer to the coordinate farthest from the horizontal coordinate axis (X-axis) where the reference position is located, or it can refer to the coordinate farthest from the vertical coordinate axis (Y-axis) where the reference position is located, or it can refer to the coordinate farthest from the reference position in a straight line.
[0148] Step S312: When the critical coordinate remains unchanged, determine the distance change trend between the real-time coordinate sampled after the critical coordinate and the reference position.
[0149] When the distances from several real-time coordinates sampled after a critical coordinate is determined to the reference position are all less than the distance from the critical coordinate to the reference position, the critical coordinate is taken as the final critical coordinate and is considered to remain unchanged. In practical applications, whether the critical coordinate remains unchanged can be determined based on 3 to 5 real-time coordinates sampled after a critical coordinate.
[0150] After determining that the critical coordinates remain unchanged, the distance change trend between the real-time coordinates sampled after determining the critical coordinates and the reference position can be used to determine whether the current boundary line of the automatic walking device is the boundary line of the isolation area.
[0151] In one embodiment, referring to Figure 8 Step S320, i.e., the step of determining whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area according to the distance change trend, includes:
[0152] Step S323: When the distance between each real-time coordinate sampled after the critical coordinate and the reference position shows an increasing trend, determine whether the distance between each real-time coordinate sampled after the critical coordinate and the critical coordinate shows a decreasing trend.
[0153] Step S324: If yes, determine that the boundary line where the autonomous driving device is currently located is the boundary line of the isolation area.
[0154] It should be noted that in practical applications, Fig. 9, the boundary line of the isolation area is not necessarily a closed boundary line that is connected end to end, but may also be a non-closed boundary line that is not connected end to end. When it is a non-closed boundary line that is not connected end to end, the automatic walking device will not return to the reference position in the end, but may cross the reference position and repeat the detour along the boundary line of the isolation area. In this case, the real-time coordinates 1, 2, and 3 will gradually move away from the reference position and approach the critical coordinates. For this scenario, in this embodiment, after determining that the critical coordinates remain unchanged, the straight-line distance between each real-time coordinate and the reference position is obtained, and the change trend of the straight-line distance between each real-time coordinate and the reference position is determined. If it shows an increasing trend, it is considered that the automatic walking device has crossed the reference position, and at this time, it is further determined whether the distance between each real-time coordinate and the critical coordinate is decreasing. If so, it is considered that the automatic walking device has crossed the reference position and is approaching the critical coordinates that have been passed before, that is, it is considered that the automatic walking device is repeatedly walking along the same trajectory, and it can be determined that it is on the boundary line of the isolation area.
[0155] If the distance between each real-time coordinate sampled after the critical coordinate and the reference position shows an increasing trend, and it is determined that the distance between each real-time coordinate sampled after the critical coordinate and the critical coordinate does not show a decreasing trend, the current travel trajectory of the automatic walking device continues to be maintained.
[0156] The above method is applicable to the following scenarios: the scenario where the automatic walking device walks along a non-closed isolation area boundary line that is not connected at the beginning and the end, and can accurately determine that the automatic walking device is at the isolation area boundary line, effectively improving the recognition ability of the special-shaped isolation area boundary line. In addition, the automatic walking device will have certain errors during the walking process. For the closed isolation area boundary line that is connected at the beginning and the end, the coordinates of the automatic walking device when walking around the isolation area boundary line for the second circle will be different from the first circle. At this time, according to the above method, it is still possible to accurately determine that the automatic walking device is at the isolation area boundary line, that is, for the non-closed isolation area boundary line that is not connected at the beginning and the end, and the closed isolation area boundary line that is connected at the beginning and the end, it can be accurately determined that the automatic walking device is at the isolation area boundary line, and it is applicable to a wide range of scenarios.
[0157] In one embodiment, referring to Fig.10 Step S311, i.e., the step of determining the critical coordinates according to the distance between each real-time coordinate and the reference position, comprises:
[0158] Step S3110: Determine whether the displacement angle change of the automatic walking device reaches a preset value.
[0159] Step S3111: If yes, determine the critical coordinates according to the distance between each real-time coordinate and the reference position.
[0160] In practical applications, the boundary line of the isolation area is not necessarily a regular shape, but may also be an irregular shape, such as Fig.11 As shown. Fig.11 When the boundary line is shown, after the critical coordinates are determined, the distance between the real-time coordinates 1, 2, and 3 of the automatic walking device and the reference position is getting farther and farther, and the distance to the critical coordinates is getting closer and closer. However, in this case, the automatic walking device does not necessarily walk around the boundary line of the isolation area, but may walk along the normal regression boundary line. For this situation, in order to prevent misjudgment, before determining the critical coordinates, in this embodiment, the displacement angle change of the automatic walking device is first obtained. When the displacement angle change reaches the preset amount, the critical coordinates are determined. Please refer to the previous text for the method of determining the critical coordinates, which will not be repeated here.
[0161] Since the displacement angle change will inevitably be large if the automatic walking device walks around the boundary line of the isolation area, first judging the displacement angle change and then making subsequent judgments can help prevent misjudgments and improve the accuracy of identifying the boundary line of the special-shaped isolation area.
[0162] The preset amount may be set to any angle value between 270° and 360°. The preset amount may be set according to the shape of the actual boundary line of the isolation area.
[0163] If the displacement angle change of the automatic walking device does not reach the preset amount, the critical coordinates will not be determined, and the walking track of the automatic walking device will continue to be maintained.
[0164] In another embodiment, step S320, i.e., the step of determining whether the current boundary line of the automatic walking device is the boundary line of the isolation area based on the distance change trend, includes: when the distance between the real-time coordinates and the reference position is continuously less than a preset threshold for a preset time period, or when the distance between the real-time coordinates and the reference position is first greater than a preset threshold and then less than or equal to the preset threshold, it is determined that the current boundary line of the automatic walking device is the boundary line of the isolation area.
[0165] When the distance between the real-time coordinates and the reference position is continuously less than the preset threshold and reaches the preset time, it is considered that the current walking direction of the automatic walking device is close to the reference position, and the boundary line where the automatic walking device is currently located can be determined to be the boundary line of the isolation area. Alternatively, when the distance between the real-time coordinates and the reference position is first greater than the preset threshold and then less than or equal to the preset threshold, it is considered that the automatic walking device first moves away from the reference position and then gradually moves toward the reference position, and it can also be determined that the automatic walking device is walking around the boundary line of the isolation area.
[0166] It should be noted that in actual applications, the following situation may occur: the initial position of the automatic walking device returning to the boundary line is near the A side of the docking station, and the B side of the docking station opposite to the A side is the position where the automatic walking device should return. At this time, the automatic walking device needs to circle the regression boundary line in a full circle to return to the B side. During its regression process, the real-time coordinates are also first away from the reference position and then close to the reference position. If it is determined that the automatic walking device is at the boundary line of the isolation area, it will cause a misjudgment. In order to prevent misjudgment in this situation, the preset threshold value can be set to a value less than one fuselage length in this embodiment. Since the distance between the A side and the B side of the docking station is often greater than one fuselage length, setting the preset threshold value to a value less than one fuselage length can avoid misjudgment.
[0167] In another embodiment, the step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates includes:
[0168] Step S330: When the distance between the real-time coordinate and the reference position is less than or equal to the body length of the autonomous vehicle, it is determined that the boundary line where the autonomous vehicle is currently located is the boundary line of the isolation area.
[0169] In this embodiment, there is no need to judge the distance change trend between each real-time coordinate and the reference position. Instead, when it is determined that the distance between the real-time coordinate and the reference position is less than or equal to the length of one fuselage of the automatic walking device, it can be determined that the current boundary line of the automatic walking device is the boundary line of the isolation area.
[0170] In a further embodiment, in step S120, i.e., the step of determining the real-time coordinates of the automatic walking device based on the reference position, it further includes: determining the quadrant of the first real-time coordinate obtained. That is, after determining the reference position, when the real-time coordinate is obtained in the first sampling period, the quadrant in which the real-time coordinate is located is determined, for example, in the first quadrant, the second quadrant, the third quadrant, or the fourth quadrant.
[0171] The steps of determining whether the autonomous vehicle is located at the boundary line of the isolation area based on the reference position and the real-time coordinates include:
[0172] S340: When the distance between the real-time coordinate and the reference position is less than or equal to the length of the body of the autonomous vehicle, determine whether the displacement angle change of the autonomous vehicle reaches a preset value, wherein the preset value may be 360°.
[0173] S350: If yes, determine the quadrant of the current coordinates.
[0174] S360: Determine whether the quadrant of the current coordinates is consistent with the quadrant of the first real-time coordinates.
[0175] S370: If yes, determine that the boundary line where the automatic traveling device is currently located is the boundary line of the isolation area.
[0176] When the automatic walking device walks normally along the regression boundary line in a complex environment, the displacement angle change may also reach a preset amount (for example, greater than 360°). Therefore, in the above embodiment, the distance between the real-time coordinates and the reference position and the displacement angle change are combined to improve the accuracy of the identification of the isolation area boundary line. At the same time, adding the judgment of the quadrant helps to prevent the automatic walking device from walking in a very small area and easily making a misjudgment.
[0177] In one embodiment, step S120, i.e., the step of determining the real-time coordinates of the autonomous driving device based on the reference position, includes: acquiring the real-time coordinates of the autonomous driving device relative to the reference position according to a preset sampling period.
[0178] For example, when the automatic walking device continues to move forward along the reference position for 80ms, the current position is sampled (which can be defined as the first sampling position), and the coordinates of the first sampling position are obtained; when the automatic walking device continues to move forward along the first sampling position for 80ms, the current position is sampled again (which can be defined as the second sampling position), and the coordinates of the second sampling position are obtained; and so on, the coordinates of multiple sampling positions can be obtained. The sampling period is not unique, and can be set to the above-mentioned 80ms, or it can be set to 50ms, 70ms or 90ms or 100ms, etc., which can be set according to actual needs. It should be noted that the sampling period should not be too large or too small. Too large will cause the coordinates to be updated too slowly, thereby reducing the efficiency of boundary line recognition. Too small will cause the coordinates to be updated too frequently, thereby increasing the internal calculation burden. In this embodiment, the sampling period is preferably set to 80ms, taking into account both the efficiency of boundary line recognition and the internal calculation burden.
[0179] Of course, the sampling of real-time coordinates is not limited to setting a fixed sampling period, but can also be randomly sampled, that is, the interval time of each sampling is not fixed, and can also be selected according to other preset rules, which can achieve the purpose of the present invention.
[0180] Preferably, refer to Fig.12 The step of obtaining the real-time coordinates of the automatic walking device relative to the reference position according to the preset sampling period includes:
[0181] S121. Obtain an initial angle when the automatic walking device is located at a reference position.
[0182] When the autonomous vehicle returns to the boundary line for the first time, a coordinate axis with the current position as the origin is established, and the angle of the autonomous vehicle can be obtained, which is used as the initial angle for subsequent calculations. In practical applications, the angle can be detected by a gyroscope installed on the autonomous vehicle.
[0183] S122: Acquire the coordinates of the first sampling position according to the displacement angle change of the first sampling position relative to the reference position and the straight-line distance between the reference position and the first sampling position.
[0184] The automatic walking device may include walking rollers and a driving motor for driving the walking rollers to walk.
[0185] Specifically, in this embodiment, the number of pulses generated by the driving motor for providing driving force for the walking roller in the sampling period is first obtained, and then the distance traveled by the walking roller in the sampling period can be calculated by combining the circumference of the walking roller, the gear ratio and the number of pulses generated by the driving motor rotating one circle, thereby obtaining the walking distance of the automatic walking device. It should be noted that if there are two or more walking rollers, the average walking distance of each walking roller can be taken as the walking distance of the automatic walking device.
[0186] The number of pulses generated by the driving motor can be obtained through a driving pulse feedback unit connected to the driving motor.
[0187] In a specific example, the automatic walking device includes two walking rollers, namely a first walking roller and a second walking roller. The first walking roller and the second walking roller are symmetrically arranged on the left and right sides of the fuselage about the central axis of the bottom of the fuselage, and the first walking roller is driven by a first drive motor, and the second walking roller is driven by a second drive motor.
[0188] The travel distance of the first walking roller in this sampling period is:
[0189] B1=A1*a1
[0190] Among them, B1 is the walking distance of the first walking roller in the sampling period; A1 is the number of pulses generated by the first drive motor in the sampling period; a1 is the distance represented by each pulse number, a1=d1 / (F1*c1), wherein F1 is the number of pulses generated by the first drive motor when it rotates one circle, c1 is the gear ratio of the first walking roller, and d1 is the circumference of the first walking roller.
[0191] The travel distance of the first walking roller in this sampling period is:
[0192] B2=A2*a2
[0193] Among them, B2 is the walking distance of the first walking roller in the sampling period; A2 is the number of pulses generated by the first drive motor in the sampling period; a2 is the distance represented by each pulse number, a2=d2 / (F2*c2), wherein F2 is the number of pulses generated by the first drive motor when it rotates one circle, c2 is the gear ratio of the first walking roller, and d2 is the circumference of the first walking roller.
[0194] The travel distance of the automatic walking device during this sampling period is:
[0195] Z1=(B1+B2) / 2
[0196] Among them, Z1 is the walking distance of the automatic walking device in the sampling period; B1 is the walking distance of the first walking roller in the sampling period; B2 is the walking distance of the second walking roller in the sampling period.
[0197] Thus, the travel distance of the automatic walking device in the sampling period is obtained, that is, the straight-line distance between the reference position and the first sampling position.
[0198] When the straight-line distance between the first sampling position and the reference position is determined and the displacement angle change of the first sampling position relative to the reference position is obtained by the gyroscope, the coordinates of the first sampling position on the coordinate axis can be determined.
[0199] Specifically, combined Fig.13 As shown, x1 = sin(δ1)*Z1, y1 = cos(δ1)*Z1, B(xb,yb) = (x1,y1). Among them, x1 is the X-axis coordinate value of the first sampling position, y1 is the Y-axis coordinate value of the first sampling position, δ1 is the displacement angle change of the first sampling position relative to the reference position, Z1 is the straight-line distance from the reference position to the first sampling position of the automatic walking device, and B(xb,yb) is the coordinate of the first sampling position (point B).
[0200] S123. Obtain the coordinates of the Nth sampling position according to the displacement angle change of the Nth sampling position relative to the reference position, the straight-line distance between the Nth sampling position and the N-1th sampling position, and the coordinates of the N-1th sampling position, where N is a natural number greater than or equal to 2.
[0201] That is, the coordinates of the second sampling position are obtained according to the displacement angle change generated based on the initial angle when the automatic walking device is located at the second sampling position, the straight-line distance between the first sampling position and the second sampling position, and the coordinates of the first sampling position.
[0202] Specifically, x2=sin(δ2)*Z2, y2=cos(δ2)*Z2, C(xc,yc)=(x2+x1,y2+y1). Among them, x1 is the X-axis coordinate value of the first sampling position, y1 is the Y-axis coordinate value of the first sampling position, δ2 is the displacement angle change generated based on the initial angle when the automatic walking device is located at the second sampling position, Z2 is the straight-line distance from the first sampling position to the second sampling position of the automatic walking device, and C(xc,yc) is the coordinate of the second sampling position (point C).
[0203] By analogy, the coordinates of the Nth sampling position can be obtained according to the displacement angle change of the Nth sampling position based on the initial angle, the straight-line distance between the Nth sampling position and the N-1th sampling position, and the coordinates of the N-1th sampling position. According to this rule, the coordinates of multiple sampling positions can be obtained.
[0204] In order to describe this solution more clearly, the following is an explanation of the process of obtaining the coordinates of multiple sampling positions in a specific example (combined with Fig.13 ):
[0205] Obtaining the coordinates of the third sampling position (point D):
[0206] x3=sin(δ3)*Z3, y3=cos(δ3)*Z3, D(xd,yd)=(x3+x2+x1,y3+y2+y1)
[0207] Among them, x2+x1 is the X-axis coordinate value of the second sampling position, y2+y1 is the Y-axis coordinate value of the second sampling position, δ3 is the displacement angle change based on the initial angle when the automatic walking device is located at the third sampling position, Z3 is the straight-line distance from the second sampling position to the third sampling position of the automatic walking device, and D(xd,yd) is the coordinate of the third sampling position (point D).
[0208] Obtaining the coordinates of the fourth sampling position (point E):
[0209] x4=sin(δ4)*Z4, y4=cos(δ4)*Z4, E(xe,ye)=(x4+x3+x2+x1,y4+y3+y2+y1);
[0210] Among them, x3+x2+x1 is the X-axis coordinate value of the third sampling position, y3+y2+y1 is the Y-axis coordinate value of the third sampling position, δ4 is the displacement angle change based on the initial angle when the automatic walking device is located at the fourth sampling position, Z4 is the straight-line distance from the third sampling position to the fourth sampling position of the automatic walking device, and E(xe,ye) is the coordinate of the fourth sampling position (point E).
[0211] The coordinates of the fifth sampling position (point F) are obtained:
[0212] x5=sin(δ5)*Z5, y5=cos(δ5)*Z5,
[0213] F(xf,yf)=(x5+x4+x3+x2+x1,y5+y4+y3+y2+y1);
[0214] Among them, x4+x3+x2+x1 is the X-axis coordinate value of the fourth sampling position, y4+y3+y2+y1 is the Y-axis coordinate value of the fourth sampling position, δ5 is the displacement angle change based on the initial angle when the automatic walking device is located at the fifth sampling position, Z5 is the straight-line distance from the fourth sampling position to the fifth sampling position of the automatic walking device, and F(xf,yf) is the coordinate of the fifth sampling position (point F).
[0215] Embodiment 2
[0216] This embodiment provides an automatic walking device, referring to Fig.14 , including a detection module 20, a determination module 22 and a control module 24.
[0217] The detection module is used to detect the marking signal when it is determined that the automatic walking device has returned;
[0218] The determination module is used to determine whether the automatic walking device is on the boundary line of the isolation area according to the detection result of the marking signal, and the boundary line of the isolation area is used to mark obstacles;
[0219] The control module is used to control the automatic walking device to leave the boundary line of the isolation area and find the return boundary line again when the automatic walking device is on the boundary line of the isolation area.
[0220] In one embodiment, the detection module is used to detect whether a magnetic signal is received when determining that the autonomous walking device is returning;
[0221] The determination module is used to determine that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area if a magnetic signal is detected;
[0222] The magnetic signal is generated by a magnetic component, and the distance between the magnetic component and a boundary line of the isolation area is less than or equal to a preset value.
[0223] Preferably, the coverage width of the magnetic signal generated by the magnetic element is greater than half the width of the fuselage and less than the width of the fuselage.
[0224] Preferably, the magnetic member includes a magnet, and the detection module includes a Hall sensor or a proximity sensor.
[0225] In one embodiment, the detection module includes:
[0226] A reference position determination unit, used to define the current position of the automatic walking device as the reference position when the automatic walking device returns and the automatic walking device is detected to be riding the line for the first time;
[0227] A real-time coordinate determination unit, used to determine the real-time coordinates of the automatic walking device based on the reference position;
[0228] The determination module is used to determine whether the automatic walking device is on the boundary line of the isolation area based on the reference position and the real-time coordinates.
[0229] The above-mentioned automatic walking device detects the marking signal when determining the regression, and determines whether the automatic walking device is on the boundary line of the isolation area used to mark the obstacle based on the detection result of the marking signal, and then when the automatic walking device is on the boundary line of the isolation area, controls the automatic walking device to leave the boundary line of the isolation area and re-find the regression boundary line. Compared with the traditional method of judging whether the automatic walking device is walking around the boundary line of the isolation area based on whether the displacement or angle change meets the predetermined value, the above-mentioned method of the present application only needs to be based on the detection result of the marking signal when determining whether the automatic walking device is on the boundary line of the isolation area, thereby avoiding the situation where the predetermined value fails due to terrain reasons and thus causes misjudgment, and improves the accuracy of regression control.
[0230] It should be noted that the automatic walking device provided in this embodiment, when realizing its functions, only uses the division of the above-mentioned functional modules as an example. In actual applications, the above-mentioned 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 provided in Example 1 belong to the same concept. The specific implementation process is detailed in the method embodiment, which will not be repeated here.
[0231] The present embodiment also provides an automatic walking system, which includes the automatic walking device provided by the aforementioned embodiment. The automatic walking system detects a marking signal when determining the regression of the automatic walking device, and determines whether the automatic walking device is on the boundary line of the isolation area used to mark obstacles based on the detection result of the marking signal, and then when the automatic walking device is on the boundary line of the isolation area, controls the automatic walking device to leave the boundary line of the isolation area and re-searches the regression boundary line. Compared with the traditional method of judging whether the automatic walking device is walking around the boundary line of the isolation area based on whether the displacement or angle change meets the predetermined value, the above-mentioned method of the present application only needs to be based on the detection result of the marking signal when determining whether the automatic walking device is on the boundary line of the isolation area, thereby avoiding the situation where the predetermined value fails due to terrain reasons and thus causes misjudgment, thereby improving the accuracy of regression control.
[0232] Embodiment 3
[0233] The present application also provides a computer device, such as Fig.15 As shown, the computer device includes a memory 400 and a processor 500. The memory 400 and the processor 500 are connected to each other in communication and can be connected via a bus or other means. Fig.15 The example of connecting through bus is taken in the following.
[0234] The processor 500 may be a central processing unit (CPU). The processor 500 may also be other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, or a combination of the above chips.
[0235] The memory 400 is a non-transitory computer-readable storage medium that can be used to store non-transitory software programs, non-transitory computer executable programs and modules, such as program instructions corresponding to the regression control method in the embodiment of the present invention. The processor 500 executes various functional applications and data processing of the processor 500 by running the non-transitory software programs, instructions and modules stored in the memory 400, that is, implementing the regression control method.
[0236] The memory 400 may include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application required by at least one function; the data storage area may store data created by the processor 500, etc. In addition, the memory 400 may include a high-speed random access memory, and may also include a non-volatile memory, such as at least one disk storage device, a flash memory device, or other non-volatile solid-state storage device. In some embodiments, the memory 400 may optionally include a memory remotely arranged relative to the processor 500, and these remote memories may be connected to the processor 500 via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.
[0237] Those skilled in the art can understand that the implementation of all or part of the processes in the above-mentioned embodiment method can be completed by instructing the relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, the storage medium can be a disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), a flash memory 400 (Flash Memory), a hard disk (Hard Disk Drive, abbreviated as: HDD) or a solid-state drive (SSD), etc.; the storage medium can also include a combination of the above-mentioned types of memory. The technical features of the above embodiments can be combined arbitrarily. In order to make the description concise, all possible combinations of the technical features in the above embodiments are not 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.
[0238] The above-mentioned embodiments only express several implementation methods of the present application, 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 a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the patent of the present application shall be subject to the attached claims.
Claims
1. A regression control method, applied to an automatic walking device, characterized in that: The method comprises: When it is determined that the automatic walking device has returned, detecting a marking signal; Determining whether the autonomous vehicle is on a boundary line of an isolation area according to a detection result of the marking signal; When the autonomous vehicle is on the boundary line of the isolation area, it moves away from the boundary line of the isolation area and searches for a return boundary line again; The step of detecting the marking signal when determining that the autonomous walking device has returned includes: when the autonomous walking device has returned and the autonomous walking device is detected to be riding the line for the first time, defining the current position of the autonomous walking device as a reference position; and determining the real-time coordinates of the autonomous walking device based on the reference position; The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area according to the detection result of the marking signal comprises: determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates; Wherein, the isolation area boundary line is used to mark obstacles.
2. The regression control method according to claim 1, characterized in that: When it is determined that the automatic walking device has returned, the step of detecting the marking signal comprises: When it is determined that the automatic walking device has returned, detecting whether a magnetic signal is received; the magnetic signal is generated by a magnetic component, and the distance between the magnetic component and the boundary line of the isolation area is less than or equal to a preset value; The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area according to the detection result of the marking signal comprises: If a magnetic signal is detected, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
3. The regression control method according to claim 1, characterized in that: The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates comprises: Determine the distance change trend between each of the real-time coordinates and the reference position; According to the distance change trend, it is determined whether the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
4. The regression control method according to claim 3, characterized in that: The step of determining whether the current boundary line of the automatic walking device is the boundary line of the isolation area according to the distance change trend includes: When the distance between the real-time coordinates and the reference position shows a decreasing trend, determining whether the distance between the current coordinates of the automatic walking device and the reference position is less than the walking distance of the automatic walking device in one sampling period; If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
5. The regression control method according to claim 3, characterized in that: The step of determining the distance change trend between each of the real-time coordinates and the reference position comprises: Determine a critical coordinate according to the distance between each of the real-time coordinates and the reference position, wherein the critical coordinate is the coordinate farthest from the reference position; When the critical coordinate remains unchanged, a distance change trend between the real-time coordinate sampled after the critical coordinate and the reference position is determined.
6. The regression control method according to claim 5, characterized in that: The step of determining whether the current boundary line of the autonomous driving device is the boundary line of the isolation area according to the distance change trend comprises: When the distance between each of the real-time coordinates sampled after the critical coordinate and the reference position shows an increasing trend, determining whether the distance between each of the real-time coordinates sampled after the critical coordinate and the critical coordinate shows a decreasing trend; If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
7. The regression control method according to claim 5, characterized in that: The step of determining the critical coordinates according to the distance between each of the real-time coordinates and the reference position comprises: Determining whether the displacement angle change of the automatic walking device reaches a preset value; If so, the critical coordinates are determined according to the distance between each of the real-time coordinates and the reference position.
8. The regression control method according to claim 3, characterized in that: The step of determining whether the current boundary line of the automatic walking device is the boundary line of the isolation area according to the distance change trend includes: When the distance between the real-time coordinates and the reference position is continuously less than a preset threshold for a preset time period, or when the distance between the real-time coordinates and the reference position is first greater than a preset threshold and then less than or equal to a preset threshold, it is determined that the current boundary line of the automatic walking device is the boundary line of the isolation area.
9. The regression control method according to claim 3, characterized in that: The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates comprises: When the distance between the real-time coordinates and the reference position is less than or equal to the body length of the autonomous driving device, it is determined that the boundary line where the autonomous driving device is currently located is the boundary line of the isolation area.
10. The regression control method according to claim 1, characterized in that: In the step of determining the real-time coordinates of the autonomous walking device based on the reference position, the method further includes: determining the quadrant of the first real-time coordinate obtained; The step of determining whether the autonomous vehicle is located on the boundary line of the isolation area based on the reference position and the real-time coordinates comprises: When the distance between the real-time coordinate and the reference position is less than or equal to the fuselage length of the automatic walking device, determining whether the displacement angle change of the automatic walking device reaches a preset value; If so, determine the quadrant of the current coordinates; Determine whether the quadrant of the current coordinates is consistent with the quadrant of the first real-time coordinates; If so, it is determined that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area.
11. The regression control method according to claim 1, characterized in that: The step of determining the real-time coordinates of the autonomous driving device based on the reference position includes: acquiring the real-time coordinates of the autonomous driving device relative to the reference position according to a preset sampling period.
12. The regression control method according to claim 11, characterized in that: The step of acquiring the real-time coordinates of the automatic walking device relative to the reference position according to a preset sampling period includes: Acquire an initial angle when the automatic walking device is located at the reference position; Acquire the coordinates of the first sampling position according to the displacement angle change of the first sampling position relative to the reference position and the straight-line distance between the reference position and the first sampling position; Obtain the displacement angle change of the Nth sampling position relative to the reference position, the straight-line distance between the Nth sampling position and the N-1th sampling position, and the coordinates of the N-1th sampling position, and obtain the coordinates of the Nth sampling position, where N is a natural number greater than or equal to 2.
13. The regression control method according to claim 12, characterized in that: The automatic walking device comprises a walking roller and a driving motor for driving the walking roller to walk, the driving motor is connected to a driving pulse feedback unit, and the automatic walking device further comprises a gyroscope; In the step of acquiring the real-time coordinates of the autonomous walking device relative to the reference position according to a preset sampling period, Acquiring the initial angle and the displacement angle change by the gyroscope; The number of pulses generated when the driving motor rotates is obtained through the driving pulse feedback unit, and the straight-line distance is determined according to the number of pulses.
14. An automatic walking device, characterized in that: include: A detection module, used for detecting a marking signal when it is determined that the automatic walking device has returned; A determination module, used to determine whether the autonomous walking device is on a boundary line of an isolation area according to a detection result of the marking signal, wherein the boundary line of the isolation area is used to mark an obstacle; A control module, used for controlling the automatic walking device to leave the boundary line of the isolation area and find a return boundary line again when the automatic walking device is on the boundary line of the isolation area; The detection module comprises: A reference position determination unit, used for defining the current position of the automatic walking device as a reference position when the automatic walking device returns and the automatic walking device is detected to be riding the line for the first time; A real-time coordinate determination unit, used to determine the real-time coordinates of the automatic walking device based on the reference position; The determination module is used to determine whether the autonomous driving device is located on the boundary line of the isolation area based on the reference position and the real-time coordinates.
15. The automatic walking device according to claim 14, characterized in that: The detection module is used to detect whether a magnetic signal is received when it is determined that the automatic walking device has returned; The determination module is used to determine that the boundary line where the automatic walking device is currently located is the boundary line of the isolation area if a magnetic signal is detected; Wherein, the magnetic signal is generated by a magnetic component, and the distance between the magnetic component and the boundary line of the isolation area is less than or equal to a preset value.
16. The automatic walking device according to claim 15, characterized in that: The coverage width of the magnetic signal generated by the magnetic element is greater than half of the width of the fuselage and less than the width of the fuselage.
17. The automatic walking device according to claim 15, characterized in that: The magnetic member includes a magnet, and the detection module includes a Hall sensor or a proximity sensor.
18. An automatic walking system, characterized in that: Comprising the automatic walking device as described in claim 14.
