WO2023160368A1 - Self-moving device control method, device, and storage medium - Google Patents

Self-moving device control method, device, and storage medium Download PDF

Info

Publication number
WO2023160368A1
WO2023160368A1 PCT/CN2023/074694 CN2023074694W WO2023160368A1 WO 2023160368 A1 WO2023160368 A1 WO 2023160368A1 CN 2023074694 W CN2023074694 W CN 2023074694W WO 2023160368 A1 WO2023160368 A1 WO 2023160368A1
Authority
WO
WIPO (PCT)
Prior art keywords
self
mobile device
target channel
reverse
moving device
Prior art date
Application number
PCT/CN2023/074694
Other languages
French (fr)
Chinese (zh)
Inventor
顾一休
杨咚浩
吴杰群
Original Assignee
追觅创新科技(苏州)有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 追觅创新科技(苏州)有限公司 filed Critical 追觅创新科技(苏州)有限公司
Publication of WO2023160368A1 publication Critical patent/WO2023160368A1/en

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present application belongs to the field of automatic control, and in particular relates to a control method, device and storage medium of a self-moving device.
  • the traditional method for leaving the narrow passage from the mobile device includes: controlling the mobile device to turn around so as to leave the narrow passage.
  • the self-mobile device may not be able to achieve direction reversal in the narrow passage, which may cause the problem that the self-mobile device cannot leave the narrow passage.
  • the present application provides a control method, device and storage medium of a self-moving device, which can solve the problem that the self-moving device may not be able to achieve direction reversal in a narrow passage, which may cause the self-moving device to be unable to leave the narrow passage.
  • This application provides the following technical solutions:
  • a method for controlling a self-moving device wherein the minimum distance between non-adjacent edge parts of the self-moving device is not equal to the maximum distance between non-adjacent edge parts; the method includes:
  • the target channel refers to a channel whose channel spacing is greater than the minimum distance and smaller than the maximum distance
  • controlling the self-mobile device to reverse to exit the target channel.
  • the self-moving device includes a wheel body and a driving member connected to the wheel body; During the traveling process of the self-moving device, the driving member runs in a first direction to drive the wheel body to move;
  • the controls for reversing from the mobile device include:
  • the driving member is controlled to run in a second direction to drive the wheel body to drive the self-moving device backward, and the second direction is opposite to the first direction.
  • controlling the self-mobile device to reverse includes:
  • the controlling the self-mobile device to reverse according to the intermediate position further includes:
  • controlling the self-mobile device to reverse according to the adjusted reverse direction includes;
  • an alarm prompt is output or a preset escape action is executed.
  • the preset escape action includes:
  • controlling the mobile device to reverse according to the intermediate position includes:
  • the preset direction is parallel to the middle line of the target channel
  • the reverse direction is corrected so that the included angle between the reverse direction and the preset direction is smaller than or equal to the angle threshold.
  • the controlling the self-mobile device to travel in the target channel it further includes:
  • the self-moving device Based on the device state of the self-moving device, it is determined whether the self-moving device can pass through the target channel.
  • the self-moving device before controlling the self-moving device to travel in the target channel, it also includes
  • the channel If the channel exists, acquire the channel spacing of the channel based on the environmental information;
  • the self-moving device is controlled to travel in the target channel.
  • the second aspect provides an electronic device, the device includes a processor and a memory; a program is stored in the memory, and the program is loaded and executed by the processor to realize the mobile device described in the first aspect control method.
  • a computer-readable storage medium where a program is stored in the storage medium, and when the program is executed by a processor, the program is used to implement the method for controlling the mobile device provided in the first aspect.
  • the beneficial effects of the present application are: by controlling the self-mobile device to travel in the target channel, the target channel refers to a channel whose channel distance is greater than the minimum distance and smaller than the maximum distance; The mobile device backs up to exit the target channel. It can solve the problem that the self-mobile device may not be able to achieve direction reversal in the narrow passage, which will cause the self-mobile device to be unable to leave the narrow passage. Controlling the self-mobile device to back up to exit the target passage by determining that the self-mobile device cannot reverse its direction of travel within the target passage. At this time, even if the self-moving device is non-circular, it will not be trapped in the target channel due to the inability to turn around, so that it can To ensure the effect of getting out of trouble from the mobile device.
  • the self-mobile device since the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid infinite times of self-mobile devices in the target channel. Collision, a problem that causes mobile devices to get stuck in the target lane.
  • the position of the self-mobile device itself may deviate greatly, thus colliding with both sides of the target channel.
  • the mobile device has a large offset, reducing the collision with the target channel twice.
  • an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device back. to avoid being trapped from your mobile device.
  • the obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
  • FIG. 1 is a schematic structural diagram of a mobile device provided by an embodiment of the present application.
  • FIG. 2 is a flow chart of a control method of a self-mobile device provided by an embodiment of the present application
  • Fig. 3 is a block diagram of an apparatus for controlling mobile devices provided by an embodiment of the present application.
  • Fig. 4 is a block diagram of an electronic device provided by an embodiment of the present application.
  • orientation words such as “upper, lower, top, bottom” are generally used for the directions shown in the drawings, or for the parts themselves in the vertical, In terms of vertical or gravitational direction; similarly, for the convenience of understanding and description, “inside and outside” refer to inside and outside relative to the outline of each component itself, but the above orientation words are not used to limit the present application.
  • FIG. 1 is a schematic structural diagram of a self-moving device provided by an embodiment of the present application.
  • the self-moving device refers to an electronic device that can move automatically without being driven by a user.
  • the self-moving device may also include other functions, such as: it may also include a cleaning function, and the self-moving device may be a sweeper, a vacuum cleaner, a mopping machine, or a washing machine, etc. This embodiment does not limit the implementation manner of the self-mobile device.
  • the minimum distance between non-adjacent edge portions and the maximum distance between non-adjacent edge portions of the self-mobile device are different. That is, the self-moving device has a non-circular shape as a whole, for example, the self-moving device has a D-shape as a whole.
  • the mobile device at least includes: a driving member 110 , a wheel body 120 and a controller 130 .
  • the driving member 110 is connected with the wheel body 120 and is used to drive the wheel body 120 to move so as to drive the mobile device to move.
  • the driving member 110 is connected with the controller 130 and used for driving the wheel body 120 to move in response to an instruction issued by the controller 130 .
  • the driving member 110 may be implemented as a DC motor, a servo motor, a stepping motor, etc., and the implementation manner of the driving member 110 is not limited in this embodiment.
  • the controller 130 is used to control the mobile device.
  • the controller 130 may be implemented as a single-chip microcomputer or a processor, and this embodiment does not limit the implementation manner of the controller 130 .
  • the controller 130 is used to: control the self-mobile device to travel in the target channel, and the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance; when it is determined that the self-mobile device cannot pass through the target channel , the control rewinds from the mobile device to exit the target channel.
  • reversing refers to a movement mode in which the driving part of the self-moving device is reversed to reverse the driving direction, so that the traveling direction of the self-moving device is reversed. Going backwards is not the same as turning around.
  • U-turn refers to a movement mode in which the driving direction of the driving member is not changed, so that the traveling direction of the self-moving device is reversed.
  • the self-moving device often needs a larger width space to realize the U-turn, while the reverse does not require a larger width space.
  • the self-mobile device is provided with a first sensor 140 .
  • the first sensor 140 is used to collect environmental information from the mobile device in the traveling direction.
  • the first sensor 140 may be a camera equipped with a color system (Red Green Blue, RGB) detection function, an infrared sensor, a laser radar sensor, etc., and the type of the first sensor 140 is not limited in this embodiment.
  • the first sensor 140 may be installed on the housing of the self-mobile device, and used to collect the environment in the direction of travel of the self-mobile device.
  • the collection range of the first sensor 140 includes, but is not limited to: the area directly in front of, obliquely above, and/or obliquely below the direction of travel of the mobile device; and/or the area on the left side of the direction of travel of the self-mobile device; The area on the right side of the traveling direction of the device; and/or the rear side area of the traveling direction of the self-mobile device, etc., this embodiment limits the collection range of the first sensor 140 .
  • the number of the first sensor 140 can be one or at least two.
  • the types of different first sensors 140 are the same or different, and this embodiment does not limit the number and implementation of the first sensors 140 .
  • the first sensor 140 is connected with the controller 130 to send the collected environmental information to the controller 130 .
  • the controller 130 determines whether there is a channel in the direction of travel based on the environmental information; if there is a channel, obtains the channel spacing of the channel based on the environmental information; , and is less than the maximum distance, control the self-mobile device to travel in the target channel.
  • the mobile device is also provided with a second sensor 150 connected to the controller 130 and configured to send sensing data to the controller 130 .
  • the controller 130 determines whether the self-mobile device can pass through the target passage based on the sensing data; if it can continue to pass the target passage, it controls the self-mobile device to continue moving; Control is then reversed from the mobile device to exit the target channel.
  • the second sensor 150 may be a collision sensor, which is used to collect collision results from the mobile device.
  • the collision sensors are installed on both sides of the traveling direction of the mobile device.
  • the controller 130 records the number of collisions between the collision sensor and the target channel based on the collision result; when the number of collisions reaches a threshold, the controller 130 controls the self-mobile device to reverse.
  • the threshold of the number of collisions is set to 16, when the value of the collision sensor reaches 16, that is, the number of collisions between the self-mobile device and the two sides of the passage reaches 16 times, at this time, the controller 130 controls the self-mobile device to reverse.
  • the self-moving device may also include other components, such as a power supply component, a shock absorption component, etc., which will not be listed here in this embodiment.
  • the self-moving device In the traditional self-moving device control method, if the self-moving device is trapped in a narrow passage, it needs to turn its direction of travel to leave the narrow passage. Problem with devices not being able to leave narrow aisles. However, in this embodiment, after determining that the self-mobile device cannot reverse its traveling direction in the target passage, the self-mobile device is controlled to reverse to exit the target passage. At this time, even if the mobile device is non-circular, it will not be due to The reason why it is impossible to turn around is trapped in the target channel, so that the escape effect of self-moving equipment can be guaranteed.
  • the method for controlling the self-mobile device will be introduced below. The following embodiments are described by taking the self-mobile device shown in FIG. 1 as an example for executing the method.
  • Fig. 2 is a flow chart of a method for controlling a self-mobile device provided by an embodiment of the present application, and the method includes at least the following steps:
  • Step 201 control the self-mobile device to travel in a target channel, where the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance.
  • the self-mobile device before the self-mobile device is controlled to travel in the target channel, it includes: acquiring environment information from the mobile device in the direction of travel; determining whether there is a channel in the direction of travel based on the environment information; The channel spacing of the information acquisition channel; when the channel spacing is greater than the minimum distance and smaller than the maximum distance, control the self-mobile device to travel in the target channel.
  • the mobile device When the channel distance is smaller than the minimum distance, it is determined that there is no target channel in the traveling direction, and the mobile device is controlled to reverse the traveling direction so as to travel in a direction away from the channel.
  • the mobile device is provided with a first sensor, the first sensor is used to collect environmental information of the mobile device in a traveling direction, and the mobile device obtains the environmental information collected by the first sensor.
  • the environmental information includes point cloud data or environmental images; correspondingly, determining whether there is a channel in the direction of travel based on the environmental information includes: performing target recognition on the environmental information to obtain a target recognition result, which is used to indicate the environment Whether the channel exists in the message.
  • the target recognition algorithm for environmental information includes but not limited to: neural network recognition, feature recognition, image segmentation recognition, etc., and this embodiment does not limit the target recognition algorithm.
  • acquiring the channel spacing of the channel based on the environmental information includes: determining the positions on both sides of the channel based on the environmental information, and determining the channel spacing based on the positions on both sides of the channel.
  • the target recognition result may also include channel spacing, which is not included in this embodiment Limit the way to obtain the channel spacing.
  • controlling the self-mobile device to travel in the target channel includes: controlling the self-mobile device to travel in the target channel in response to a control instruction.
  • the cleaning device is connected in communication with the control device, and the control device is used to control the movement of the mobile device.
  • the control device may be a remote controller, a mobile phone, a tablet computer, a wearable device, etc., and this embodiment does not limit the type of the control device.
  • the whole travels along the middle position of the target passage.
  • the intermediate position is determined from the mobile device based on the channel spacing of the target channel. Specifically, the middle position is 1/2 of the channel pitch.
  • determining whether the mobile device can continue to pass through the target channel includes but is not limited to the following two methods:
  • the first one is to determine whether the self-mobile device can pass through the target channel based on the number of times the self-mobile device collides during the traveling process.
  • a collision sensor is provided on the self-mobile device to collect whether the self-mobile device collides during travel.
  • determining whether the self-mobile device can pass through the target channel based on the number of times the self-mobile device collides during the traveling process includes: determining that the self-mobile device cannot pass the target channel when the number of collisions occurs reaches a preset threshold; When the number of collisions is less than the preset number of thresholds, if the self-mobile device collides with the left side of the channel, the mobile device will be controlled to shift to the right by a preset angle and continue to move forward. When a collision occurs on the right side, the automatic equipment is controlled to shift to the left by a preset angle and continue to move forward.
  • the preset angle is pre-stored in the self-mobile device, and the preset angle may be 5°, 10°, etc., and this embodiment does not limit the value of the preset angle.
  • the preset angle of offset to the right and the preset angle of offset to the left may also be different, and this embodiment does not limit the way of offsetting the angle from the mobile device.
  • the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid self-moving problems.
  • Mobile device collides infinitely in the target channel, causing self-mobile device to be stuck in the target channel.
  • the second type is to determine whether the self-mobile device can pass through the target channel based on the device state of the self-mobile device.
  • the device status includes remaining battery power from the mobile device.
  • determining whether the self-mobile device can pass through the target channel includes: determining that the self-mobile device cannot pass through the target channel when the remaining power of the self-mobile device is less than or equal to a preset power threshold; In the case that the remaining power of the mobile device is greater than the preset power threshold, the remaining power of the mobile device is acquired again, so as to compare the remaining power with the preset power threshold.
  • the self-mobile device cannot pass through the target channel when the remaining power is low, the problem that the self-mobile device cannot leave the target channel due to insufficient power can be prevented, resulting in the self-mobile device being unable to complete the cleaning work.
  • the cleaning device is provided with a dirt sensor, which is used to obtain the degree of dirt of the cleaning mechanism, and the state of the device includes the degree of dirt of the cleaning mechanism of the self-moving device .
  • determining whether the self-moving device can pass through the target channel includes: determining that the self-moving device cannot pass through when the degree of dirtiness of the cleaning mechanism of the self-moving device is greater than a preset dirtiness threshold Target channel; when the degree of dirtiness from the cleaning mechanism of the mobile device is less than or equal to the preset threshold value of the degree of dirtiness, obtain the degree of dirtiness from the cleaning mechanism of the mobile device again, so as to compare the degree of dirtiness with the preset threshold value of the degree of dirtiness Compare.
  • Step 202 if it is determined that the mobile device cannot pass through the target channel, control the mobile device backwards to exit the target channel.
  • controlling the self-moving device to reverse includes: the controller controls the driving member to run in a second direction, and the driving wheel body drives the self-mobile device to reverse, and the second direction is opposite to the first direction.
  • the reverse in this embodiment refers to: the controller controls the driving member to run in the opposite direction to the forward direction, so as to realize the reverse of the self-moving device. At this time, even if the self-moving device is non-circular, it can It will not be trapped in the target channel due to the inability to turn around, so that the escape effect of self-moving equipment can be guaranteed.
  • controlling the self-mobile device to reverse includes: acquiring an intermediate position of the target channel; controlling the self-mobile device to reverse according to the intermediate position.
  • the middle position of the target channel Since the middle position of the target channel has been recorded during the traveling process, the middle position of the target channel can be obtained by reading the historical records of the traveling process.
  • the first sensor may collect environmental information of the target channel, determine the channel distance of the target channel based on the environmental information, and determine the intermediate position based on the channel distance.
  • controlling the self-mobile device to reverse according to the middle position includes: acquiring the self-mobile device's reverse direction; determining whether the included angle between the reversed direction and the preset direction is greater than the angle threshold; The direction is corrected so that the angle between the reverse direction and the preset direction is less than or equal to the angle threshold.
  • the preset direction is parallel to the middle line of the target channel.
  • the body position of the self-moving device itself may deviate greatly during the reverse process, thus colliding with both sides of the target channel, at this time, by correcting the position of the body and correcting the reverse direction, the self-moving device can be avoided.
  • a large offset occurs to reduce collisions with the sides of the target channel.
  • the self-mobile device may also go backwards according to the travel route, and at this time, the self-mobile device stores the travel route.
  • steps S1 and S2 are also included:
  • Step S1 in the case of a collision with the self-mobile device, adjust the reverse direction based on the location of the collision.
  • the reverse direction is adjusted to a preset angle away from the collision position to obtain an adjusted backward direction.
  • the self-mobile device is provided with a collision sensor, and when a collision is detected, the reverse direction is adjusted to a preset angle away from the direction where the collision occurs to obtain the adjusted reverse direction.
  • the preset angle is pre-stored in the self-mobile device, and the preset angle may be 5°, 10°, etc., and this embodiment does not limit the value of the preset angle.
  • step S1 before adjusting the reversing direction based on the collision position, that is, before step S1, it also includes: recording the number of collisions in the reversing process from the mobile device; when the number of times reaches the number threshold, output a warning prompt or execute a preset escape action.
  • the alarm prompt can be the alarm prompt voice issued by the self-mobile device itself, or the alarm prompt is sent to the mobile terminal bound with the self-mobile device.
  • This embodiment does not limit the output mode of the alarm prompt.
  • an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device away, Thus avoiding being trapped from mobile devices.
  • the preset escape action includes: adjusting the reverse drive power to the maximum power; reverse according to the maximum power; or, after controlling the mobile device to advance a certain distance, adjust the reverse drive power to the maximum power; reverse according to the maximum power .
  • the obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
  • Step S2 controlling the self-mobile device to reverse according to the adjusted reverse direction.
  • the control method of the self-moving device controls the self-mobile device to travel in the target channel, and the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance; In the event that the target channel cannot be passed, the control rewinds from the mobile device to exit the target channel. It can solve the problem that the self-mobile device may not be able to achieve direction reversal in the narrow passage, which will cause the self-mobile device to be unable to leave the narrow passage. Exit by controlling the self-mobile device to reverse direction of travel after determining that the self-mobile device cannot reverse the direction of travel within the target lane target channel. At this time, even if the self-moving device is non-circular, it will not be trapped in the target channel due to the inability to turn around, so that the self-moving device's escape effect can be guaranteed.
  • the self-mobile device since the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid infinite times of self-mobile devices in the target channel. Collision, a problem that causes mobile devices to get stuck in the target lane.
  • the position of the self-mobile device itself may deviate greatly, thus colliding with both sides of the target channel.
  • the mobile device has a large offset, reducing the collision with the target channel twice.
  • an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device back. to avoid being trapped from your mobile device.
  • the obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
  • FIG. 3 is a block diagram of a self-moving device control device provided by an embodiment of the present application. This embodiment is described by taking the device applied to the self-moving device shown in FIG. 1 as an example.
  • the device at least includes the following modules: a forward module 310 and a reverse module 320 .
  • the traveling module 310 is used to control the self-mobile device to travel in the target channel, and the target channel refers to Channels whose channel spacing is greater than the minimum distance and less than the maximum distance;
  • the reversing module 320 is configured to control the ego mobile device to regress to exit the target passage when it is determined that the ego mobile device cannot pass through the target passage.
  • the self-mobile device control device when the self-mobile device control device provided in the above-mentioned embodiments performs control, the division of the above-mentioned functional modules is used as an example for illustration. In practical applications, the above-mentioned functions can be assigned to different functional modules according to needs. To complete means to divide the internal structure of the mobile device control device into different functional modules, so as to complete all or part of the functions described above.
  • the apparatus for controlling self-moving equipment provided in the above-mentioned embodiments and the embodiment of the method for controlling self-moving equipment belong to the same concept, and its specific implementation process is detailed in the method embodiment, and will not be repeated here.
  • the electronic device may be the self-moving device in FIG. 1 .
  • the electronic device includes at least a processor 401 and a memory 402 .
  • the processor 401 may include one or more processing cores, such as a 4-core processor, an 8-core processor, and the like.
  • Processor 401 can adopt at least one hardware form in DSP (Digital Signal Processing, digital signal processing), FPGA (Field-Programmable Gate Array, field programmable gate array), PLA (Programmable Logic Array, programmable logic array) accomplish.
  • Processor 401 may also include a main processor and a coprocessor, and the main processor is a processor for processing data in a wake-up state, also known as a CPU (Central Processing Unit, central processing unit); the coprocessor is Low-power processor for processing data in standby state.
  • CPU Central Processing Unit, central processing unit
  • the coprocessor is Low-power processor for processing data in standby state.
  • the processor 401 may be integrated with a GPU (Graphics Processing Unit, image processor), and the GPU is used for rendering and drawing the content that needs to be displayed on the display screen.
  • the processor 401 may also include an AI (Artificial Intelligence, artificial intelligence) processor, where the AI processor is used to process computing operations related to machine learning.
  • AI Artificial Intelligence, artificial intelligence
  • Memory 402 may include one or more computer-readable storage media, which may be non-transitory.
  • the memory 402 may also include high-speed random access memory and non-volatile memory, such as one or more magnetic disk storage devices and flash memory storage devices.
  • the non-transitory computer-readable storage medium in the memory 402 is used to store at least one instruction, and the at least one instruction is used to be executed by the processor 401 to realize the self-mobile device provided by the method embodiments in this application Control Method.
  • the electronic device may optionally further include: a peripheral device interface and at least one peripheral device.
  • the processor 401, the memory 402, and the peripheral device interface may be connected through a bus or a signal line.
  • Each peripheral device can be connected with the peripheral device interface through a bus, a signal line or a circuit board.
  • peripheral devices include but are not limited to: radio frequency circuits, touch screens, audio circuits, and power supplies.
  • the electronic device may also include fewer or more components, which is not limited in this embodiment.
  • the present application also provides a computer-readable storage medium, where a program is stored in the computer-readable storage medium, and the program is loaded and executed by a processor to implement the self-mobile device control method of the foregoing method embodiment.

Landscapes

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

Abstract

A self-moving device control method, a device, and a storage medium, wherein the method comprises: controlling a self-moving device to travel in a target passage, the target passage referring to a passage having a passage spacing greater than a minimum distance and less than a maximum distance (201); and when it is determined that the self-moving device is unable to pass through the target passage, controlling the self-moving device to reverse so as to exit the target passage (202). The problem that the self-moving device may not be able to achieve direction reversal in a narrow passage, resulting in that the self-moving device cannot leave the narrow passage can be solved; and after determining that the self-moving device cannot reverse the direction of travel in the target passage, the self-moving device is controlled to reverse to exit the target passage, so that even if the self-moving device is non-circular, the self-moving device is prevented from being trapped in the target passage due to the inability to turn around, thereby ensuring the escape effect of the self-moving device.

Description

自移动设备的控制方法、设备及存储介质Control method, device and storage medium of mobile device
本申请要求如下专利申请的优先权:于2022年02月25日提交中国专利局、申请号为202210190809.X、发明名称为“自移动设备的控制方法、设备及存储介质”的中国专利申请,上述专利申请的全部内容通过引用结合在本申请中。This application claims the priority of the following patent application: a Chinese patent application filed with the China Patent Office on February 25, 2022, with the application number 202210190809.X and the title of the invention "Control method, device and storage medium for self-moving devices", The entire contents of the aforementioned patent applications are incorporated by reference in this application.
技术领域technical field
本申请属于自动控制领域,具体涉及一种自移动设备的控制方法、设备及存储介质。The present application belongs to the field of automatic control, and in particular relates to a control method, device and storage medium of a self-moving device.
背景技术Background technique
目前,自移动设备可以通过碰撞的方式进入窄通道,并在窄通道内移动。自移动设备无法穿过窄通道的情况下,需要离开窄通道。Currently, self-mobile devices can enter narrow passages through collisions and move within narrow passages. In the event that the mobile device cannot pass through the narrow passage, it is necessary to leave the narrow passage.
传统的自移动设备离开窄通道的方法包括:控制自移动设备掉头,以离开窄通道。The traditional method for leaving the narrow passage from the mobile device includes: controlling the mobile device to turn around so as to leave the narrow passage.
然而,自移动设备可能无法在窄通道内实现方向调转,会导致自移动设备无法离开窄通道的问题。However, the self-mobile device may not be able to achieve direction reversal in the narrow passage, which may cause the problem that the self-mobile device cannot leave the narrow passage.
发明内容Contents of the invention
本申请提供了自移动设备的控制方法、设备及存储介质,可以解决自移动设备可能无法在窄通道内实现方向调转,会导致自移动设备无法离开窄通道的问题。本申请提供如下技术方案:The present application provides a control method, device and storage medium of a self-moving device, which can solve the problem that the self-moving device may not be able to achieve direction reversal in a narrow passage, which may cause the self-moving device to be unable to leave the narrow passage. This application provides the following technical solutions:
第一方面,提供了一种自移动设备的控制方法,所述自移动设备不相邻边缘部分之间的最小距离与不相邻边缘部分之间的最大距离不等;所述方法包括:In a first aspect, a method for controlling a self-moving device is provided, wherein the minimum distance between non-adjacent edge parts of the self-moving device is not equal to the maximum distance between non-adjacent edge parts; the method includes:
控制所述自移动设备在目标通道内行进,所述目标通道是指通道间距大于所述最小距离、且小于所述最大距离的通道;controlling the self-moving device to travel in a target channel, where the target channel refers to a channel whose channel spacing is greater than the minimum distance and smaller than the maximum distance;
在确定出所述自移动设备无法通过所述目标通道的情况下,控制所述自移动设备倒退,以退出所述目标通道。When it is determined that the self-moving device cannot pass through the target channel, controlling the self-mobile device to reverse to exit the target channel.
可选地,所述自移动设备包括轮体、以及与所述轮体相连的驱动件; 所述自移动设备在行进过程中,所述驱动件以第一方向运行,以驱动所述轮体运动;Optionally, the self-moving device includes a wheel body and a driving member connected to the wheel body; During the traveling process of the self-moving device, the driving member runs in a first direction to drive the wheel body to move;
所述控制所述自移动设备倒退,包括:The controls for reversing from the mobile device include:
控制所述驱动件以第二方向运行,以驱动所述轮体带动所述自移动设备倒退,所述第二方向与所述第一方向相反。The driving member is controlled to run in a second direction to drive the wheel body to drive the self-moving device backward, and the second direction is opposite to the first direction.
可选地,所述控制所述自移动设备倒退,包括:Optionally, the controlling the self-mobile device to reverse includes:
获取所述目标通道的中间位置;Obtain the middle position of the target channel;
控制所述自移动设备按照所述中间位置倒退。Controlling the self-mobile device to reverse according to the intermediate position.
可选地,所述控制所述自移动设备按照所述中间位置倒退之后,还包括:Optionally, after the controlling the self-mobile device to reverse according to the intermediate position, further includes:
在所述自移动设备发生碰撞的情况下,基于碰撞位置调整倒退方向;In the event that the self-mobile device collides, adjusting a reverse direction based on the collision location;
控制所述自移动设备按照调整后的倒退方向倒退。Controlling the self-mobile device to reverse according to the adjusted reverse direction.
可选地,所述控制所述自移动设备按照调整后的倒退方向倒退,包括;Optionally, the controlling the self-mobile device to reverse according to the adjusted reverse direction includes;
将所述倒退方向向远离所述碰撞位置的方向调整预设角度,得到所述调整后的倒退方向。Adjusting the reverse direction to a direction away from the collision position by a preset angle to obtain the adjusted reverse direction.
可选地,所述基于碰撞位置调整倒退方向之前,还包括:Optionally, before adjusting the reverse direction based on the collision position, it also includes:
记录所述自移动设备在倒退过程中发生碰撞的次数;Recording the number of times that the self-mobile device collides during the backward process;
在所述次数达到次数阈值的情况下,输出告警提示或执行预设脱困动作。When the number of times reaches the number threshold, an alarm prompt is output or a preset escape action is executed.
可选地,所述预设脱困动作包括:Optionally, the preset escape action includes:
将倒退的驱动功率调节至最大功率;按照所述最大功率倒退;Regulate the driving power of reverse to the maximum power; reverse according to the maximum power;
或者,or,
控制所述自移动设备前进一定距离后,将倒退的驱动功率调节至最大功率;按照所述最大功率倒退。After controlling the self-moving device to advance a certain distance, adjust the reverse drive power to the maximum power; reverse according to the maximum power.
可选地,所述控制所述自移动设备按照所述中间位置倒退,包括:Optionally, the controlling the mobile device to reverse according to the intermediate position includes:
获取所述自移动设备倒退方向;Obtain the reverse direction from the mobile device;
确定所述倒退方向与预设方向之间的夹角是否大于角度阈值;所述预设方向平行于所述目标通道的中间线; determining whether the included angle between the reverse direction and a preset direction is greater than an angle threshold; the preset direction is parallel to the middle line of the target channel;
在所述夹角大于角度阈值的情况下,对所述倒退方向进行矫正,以使所述倒退方向与所述预设方向之间的夹角小于或等于所述角度阈值。If the included angle is greater than an angle threshold, the reverse direction is corrected so that the included angle between the reverse direction and the preset direction is smaller than or equal to the angle threshold.
可选地,所述控制所述自移动设备在目标通道内行进之后,还包括:Optionally, after the controlling the self-mobile device to travel in the target channel, it further includes:
基于所述自移动设备在行进过程中发生碰撞的次数,确定所述自移动设备是否能够通过所述目标通道;determining whether the self-moving device can pass through the target channel based on the number of times the self-moving device collides during travel;
或者,or,
基于所述自移动设备的设备状态,确定所述自移动设备是否能够通过所述目标通道。Based on the device state of the self-moving device, it is determined whether the self-moving device can pass through the target channel.
可选地,所述控制所述自移动设备在目标通道内行进之前,还包括Optionally, before controlling the self-moving device to travel in the target channel, it also includes
获取所述自移动设备在行进方向上的环境信息;Acquiring environmental information of the self-mobile device in the direction of travel;
基于所述环境信息确定所述行进方向上是否存在所述通道;determining whether the passage exists in the traveling direction based on the environmental information;
在存在所述通道的情况下,基于所述环境信息获取所述通道的通道间距;If the channel exists, acquire the channel spacing of the channel based on the environmental information;
在所述通道间距大于所述最小距离、且小于所述最大距离的情况下,控制所述自移动设备在所述目标通道内行进。In the case that the channel distance is greater than the minimum distance and smaller than the maximum distance, the self-moving device is controlled to travel in the target channel.
第二方面,提供了一种电子设备,所述设备包括处理器和存储器;所述存储器中存储有程序,所述程序由所述处理器加载并执行以实现第一方面所述的自移动设备的控制方法。The second aspect provides an electronic device, the device includes a processor and a memory; a program is stored in the memory, and the program is loaded and executed by the processor to realize the mobile device described in the first aspect control method.
第三方面,提供一种计算机可读存储介质,所述存储介质中存储有程序,所述程序被处理器执行时用于实现第一方面提供的自移动设备的控制方法。In a third aspect, a computer-readable storage medium is provided, where a program is stored in the storage medium, and when the program is executed by a processor, the program is used to implement the method for controlling the mobile device provided in the first aspect.
本申请的有益效果在于:通过控制自移动设备在目标通道内行进,目标通道是指通道间距大于最小距离、且小于最大距离的通道;在确定出自移动设备无法通过目标通道的情况下,控制自移动设备倒退,以退出目标通道。可以解决自移动设备可能无法在窄通道内实现方向调转,会导致自移动设备无法离开窄通道的问题。通过确定自移动设备无法在目标通道内调转行进方向后,控制自移动设备倒退以退出目标通道。此时,即使自移动设备为非圆形,也不会由于无法掉头的原因在目标通道内困住,从而可 以保证自移动设备的脱困效果。The beneficial effects of the present application are: by controlling the self-mobile device to travel in the target channel, the target channel refers to a channel whose channel distance is greater than the minimum distance and smaller than the maximum distance; The mobile device backs up to exit the target channel. It can solve the problem that the self-mobile device may not be able to achieve direction reversal in the narrow passage, which will cause the self-mobile device to be unable to leave the narrow passage. Controlling the self-mobile device to back up to exit the target passage by determining that the self-mobile device cannot reverse its direction of travel within the target passage. At this time, even if the self-moving device is non-circular, it will not be trapped in the target channel due to the inability to turn around, so that it can To ensure the effect of getting out of trouble from the mobile device.
另外,由于自移动设备在目标通道内行进方向上可能会发生多次碰撞,此时,基于碰撞次数确定自移动设备是否能继续在目标通道内行进,可以避免自移动设备在目标通道内无限次碰撞,导致自移动设备困在目标通道内的问题。In addition, since the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid infinite times of self-mobile devices in the target channel. Collision, a problem that causes mobile devices to get stuck in the target lane.
另外,通过在剩余电量较低时,确定自移动设备不能通过目标通道,可以防止自移动设备因电量不足导致不能离开目标通道,从而导致自移动设备不能完成清洁工作的问题。In addition, by determining that the self-moving device cannot pass through the target passage when the remaining power is low, it is possible to prevent the self-moving device from being unable to leave the target passage due to insufficient power, thereby causing the self-moving device to fail to complete the cleaning work.
另外,通过在清洁机构脏污程度较高时,确定自移动设备不能通过目标通道,可以防止自移动设备因清洁机构脏污程度高,导致不能在目标通道内达到预期清洁效果的问题,从而保证了自移动设备的清洁效率。In addition, by determining that the self-moving device cannot pass through the target channel when the cleaning mechanism is highly dirty, it is possible to prevent the problem that the self-moving device cannot achieve the expected cleaning effect in the target channel due to the high degree of dirt of the cleaning mechanism, thereby ensuring Improved cleaning efficiency from mobile equipment.
另外,由于在倒退过程中,自移动设备自身的机身位置可能发生较大偏移,从而与目标通道两侧发生碰撞,此时通过矫正机身位置,并对倒退方向进行矫正,可以避免自移动设备发生较大偏移,减少与目标通道两次的碰撞。In addition, during the process of reversing, the position of the self-mobile device itself may deviate greatly, thus colliding with both sides of the target channel. The mobile device has a large offset, reducing the collision with the target channel twice.
另外,由于自移动设备在倒退过程中可能会遇到可移动的障碍物,此时可以通过输出告警提示以告知用户存在障碍物,以使用户及时将障碍物移除,或者将自移动设备搬离,从而避免自移动设备被困。In addition, since the self-mobile device may encounter movable obstacles in the process of reversing, at this time, an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device back. to avoid being trapped from your mobile device.
另外,由于自移动设备在倒退过程中在某位置遇到的障碍物,可能是自移动设备经过该位置后被移动至该位置的障碍物。此时,障碍物可移动的概率较大。此时,通过加大功率撞开该障碍物的概率较大,可以避免自移动设备在倒退过程中被困的问题。In addition, the obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
附图说明Description of drawings
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。 In order to more clearly illustrate the specific embodiments of the present invention or the technical solutions in the prior art, the accompanying drawings that need to be used in the description of the specific embodiments or the prior art will be briefly introduced below. Obviously, the accompanying drawings in the following description These are some implementations of the present invention. For those skilled in the art, other drawings can also be obtained according to these drawings without creative work.
图1是本申请一个实施例提供的自移动设备的结构示意图;FIG. 1 is a schematic structural diagram of a mobile device provided by an embodiment of the present application;
图2是本申请一个实施例提供的自移动设备的控制方法的流程图;FIG. 2 is a flow chart of a control method of a self-mobile device provided by an embodiment of the present application;
图3是本申请一个实施例提供的自移动设备控制装置的框图;Fig. 3 is a block diagram of an apparatus for controlling mobile devices provided by an embodiment of the present application;
图4是本申请一个实施例提供的电子设备的框图。Fig. 4 is a block diagram of an electronic device provided by an embodiment of the present application.
具体实施方式Detailed ways
下面将结合附图对本申请的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。下文中将参考附图并结合实施例来详细说明本申请。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。The technical solutions of the present application will be clearly and completely described below in conjunction with the accompanying drawings. Apparently, the described embodiments are some of the embodiments of the present application, not all of them. Hereinafter, the present application will be described in detail with reference to the drawings and embodiments. It should be noted that, in the case of no conflict, the embodiments in the present application and the features in the embodiments can be combined with each other.
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。It should be noted that the terms "first" and "second" in the description and claims of the present application and the above drawings are used to distinguish similar objects, but not necessarily used to describe a specific sequence or sequence.
在本申请中,在未作相反说明的情况下,使用的方位词如“上、下、顶、底”通常是针对附图所示的方向而言的,或者是针对部件本身在竖直、垂直或重力方向上而言的;同样地,为便于理解和描述,“内、外”是指相对于各部件本身的轮廓的内、外,但上述方位词并不用于限制本申请。In this application, unless stated to the contrary, the used orientation words such as "upper, lower, top, bottom" are generally used for the directions shown in the drawings, or for the parts themselves in the vertical, In terms of vertical or gravitational direction; similarly, for the convenience of understanding and description, "inside and outside" refer to inside and outside relative to the outline of each component itself, but the above orientation words are not used to limit the present application.
图1是本申请一个实施例提供的自移动设备的结构示意图,自移动设备是指无需用户驱动,即可实现自动移动的电子设备。可选地,自移动设备除了包括自移动功能之外,还可以包括其它功能,比如:还可以包括清洁功能,该自移动设备可以为扫地机、吸尘器、拖地机、或者洗地机等,本实施例不对自移动设备的实现的方式作限定。FIG. 1 is a schematic structural diagram of a self-moving device provided by an embodiment of the present application. The self-moving device refers to an electronic device that can move automatically without being driven by a user. Optionally, in addition to the self-moving function, the self-moving device may also include other functions, such as: it may also include a cleaning function, and the self-moving device may be a sweeper, a vacuum cleaner, a mopping machine, or a washing machine, etc. This embodiment does not limit the implementation manner of the self-mobile device.
本实施例中,自移动设备不相邻边缘部分之间的最小距离与不相邻边缘部分之间的最大距离不等。即,自移动设备整体呈非圆形形状,比如:自移动设备整体呈D型。In this embodiment, the minimum distance between non-adjacent edge portions and the maximum distance between non-adjacent edge portions of the self-mobile device are different. That is, the self-moving device has a non-circular shape as a whole, for example, the self-moving device has a D-shape as a whole.
根据图1可知,自移动设备至少包括:驱动件110、轮体120和控制器130。It can be seen from FIG. 1 that the mobile device at least includes: a driving member 110 , a wheel body 120 and a controller 130 .
驱动件110与轮体120相连,并用于驱动轮体120运动,以带动自移动设备移动。 The driving member 110 is connected with the wheel body 120 and is used to drive the wheel body 120 to move so as to drive the mobile device to move.
驱动件110与控制器130相连,并用于响应控制器130发出的指令驱动轮体120运动。The driving member 110 is connected with the controller 130 and used for driving the wheel body 120 to move in response to an instruction issued by the controller 130 .
可选地,驱动件110可以实现为直流电机、伺服电机、步进电机等,本实施例不对驱动件110的实现方式作限定。Optionally, the driving member 110 may be implemented as a DC motor, a servo motor, a stepping motor, etc., and the implementation manner of the driving member 110 is not limited in this embodiment.
控制器130用于对自移动设备进行控制。可选地,控制器130可以实现为单片机,或者处理器,本实施例不对控制器130的实现方式作限定。The controller 130 is used to control the mobile device. Optionally, the controller 130 may be implemented as a single-chip microcomputer or a processor, and this embodiment does not limit the implementation manner of the controller 130 .
本实施例中,控制器130用于:控制自移动设备在目标通道内行进,目标通道是指通道间距大于最小距离、且小于最大距离的通道;在确定出自移动设备无法通过目标通道的情况下,控制自移动设备倒退,以退出目标通道。In this embodiment, the controller 130 is used to: control the self-mobile device to travel in the target channel, and the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance; when it is determined that the self-mobile device cannot pass through the target channel , the control rewinds from the mobile device to exit the target channel.
其中,倒退是指:自移动设备的驱动件反转,以调转驱动方向,从而使自移动设备的行进方向相反的运动方式。倒退与掉头不同。具体地,掉头是指不改变驱动件的驱动方向,从而使自移动设备的行进方向相反的运动方式。在掉头过程中,自移动设备往往需要较大的宽度空间,才能实现掉头,而倒退并不需要较大的宽度空间。Wherein, reversing refers to a movement mode in which the driving part of the self-moving device is reversed to reverse the driving direction, so that the traveling direction of the self-moving device is reversed. Going backwards is not the same as turning around. Specifically, U-turn refers to a movement mode in which the driving direction of the driving member is not changed, so that the traveling direction of the self-moving device is reversed. During the U-turn process, the self-moving device often needs a larger width space to realize the U-turn, while the reverse does not require a larger width space.
可选地,为了确定自移动设备行进方向上是否存在目标通道,自移动设备上设置有第一传感器140。Optionally, in order to determine whether there is a target channel in the traveling direction of the self-mobile device, the self-mobile device is provided with a first sensor 140 .
第一传感器140用于采集自移动设备在行进方向上的环境信息。可选地,第一传感器140可以为搭载有颜色系统(Red Green Blue,RGB)检测功能的相机、红外传感器、激光雷达传感器等,本实施例不对第一传感器140的类型作限定。The first sensor 140 is used to collect environmental information from the mobile device in the traveling direction. Optionally, the first sensor 140 may be a camera equipped with a color system (Red Green Blue, RGB) detection function, an infrared sensor, a laser radar sensor, etc., and the type of the first sensor 140 is not limited in this embodiment.
可选地,第一传感器140可以安装于自移动设备的壳体上,且用于对自移动设备行进方向的环境进行采集。第一传感器140的采集范围包括但不限于:在自移动设备的行进方向正前方、斜上方和/或斜下方区域;和/或自移动设备的行进方向的左侧区域;和/或自移动设备的行进方向的右侧区域;和/或自移动设备的行进方向的后侧区域等,本实施例对第一传感器140的采集范围作限定。Optionally, the first sensor 140 may be installed on the housing of the self-mobile device, and used to collect the environment in the direction of travel of the self-mobile device. The collection range of the first sensor 140 includes, but is not limited to: the area directly in front of, obliquely above, and/or obliquely below the direction of travel of the mobile device; and/or the area on the left side of the direction of travel of the self-mobile device; The area on the right side of the traveling direction of the device; and/or the rear side area of the traveling direction of the self-mobile device, etc., this embodiment limits the collection range of the first sensor 140 .
可选地,第一传感器140的数量可以为一个或至少两个,在第一传感 器140的数量为至少两个的情况下,不同第一传感器140的类型相同或不同,本实施例不对第一传感器140的数量和实现方式作限定。Optionally, the number of the first sensor 140 can be one or at least two. When the number of sensors 140 is at least two, the types of different first sensors 140 are the same or different, and this embodiment does not limit the number and implementation of the first sensors 140 .
第一传感器140与控制器130相连,以将采集到的环境信息发送至控制器130。The first sensor 140 is connected with the controller 130 to send the collected environmental information to the controller 130 .
相应地,在获取到行进方向上的环境信息后,控制器130基于环境信息确定行进方向上是否存在通道;在存在通道的情况下,基于环境信息获取通道的通道间距;在通道间距大于最小距离、且小于最大距离的情况下,控制自移动设备在目标通道内行进。Correspondingly, after acquiring the environmental information in the direction of travel, the controller 130 determines whether there is a channel in the direction of travel based on the environmental information; if there is a channel, obtains the channel spacing of the channel based on the environmental information; , and is less than the maximum distance, control the self-mobile device to travel in the target channel.
可选地,自移动设备上还设置有第二传感器150,第二传感器150与控制器130相连,并用于向控制器130发送传感数据。相应地,控制器130在接收到传感数据后,基于传感数据确定自移动设备是否能通过目标通道;若能继续通过目标通道,则控制自移动设备继续行进;若不能继续通过目标通道,则控制自移动设备倒退,以退出目标通道。Optionally, the mobile device is also provided with a second sensor 150 connected to the controller 130 and configured to send sensing data to the controller 130 . Correspondingly, after receiving the sensing data, the controller 130 determines whether the self-mobile device can pass through the target passage based on the sensing data; if it can continue to pass the target passage, it controls the self-mobile device to continue moving; Control is then reversed from the mobile device to exit the target channel.
示意性地,第二传感器150可以为碰撞传感器,碰撞传感器用于采集自移动设备的碰撞结果。可选地,碰撞传感器安装于自移动设备的行进方向的两侧。在行进过程中,控制器130会基于碰撞结果记录碰撞传感器与目标通道的碰撞次数;在碰撞次数达到阈值的情况下,控制器130控制自移动设备倒退。Schematically, the second sensor 150 may be a collision sensor, which is used to collect collision results from the mobile device. Optionally, the collision sensors are installed on both sides of the traveling direction of the mobile device. During the traveling process, the controller 130 records the number of collisions between the collision sensor and the target channel based on the collision result; when the number of collisions reaches a threshold, the controller 130 controls the self-mobile device to reverse.
比如:碰撞次数阈值设置为16,当碰撞传感器的数值达到16时,即,自移动设备与通道两边的碰撞次数达到16次,此时,控制器130控制自移动设备进行倒退。For example, the threshold of the number of collisions is set to 16, when the value of the collision sensor reaches 16, that is, the number of collisions between the self-mobile device and the two sides of the passage reaches 16 times, at this time, the controller 130 controls the self-mobile device to reverse.
需要补充说明的是,在实际实现时,自移动设备还可以包括其它元器件,如:供电组件、减震组件等,本实施例在此不再一一列举。It should be added that, in actual implementation, the self-moving device may also include other components, such as a power supply component, a shock absorption component, etc., which will not be listed here in this embodiment.
传统的自移动设备控制方法中,自移动设备在窄通道内被困需要调转行进方向,以离开窄通道,然而非圆形的自移动设备可能无法在窄通道内实现方向调转,会导致自移动设备无法离开窄通道的问题。而本实施例中,通过确定自移动设备无法在目标通道内调转行进方向后,通过控制自移动设备倒退以退出目标通道。此时,即使自移动设备为非圆形,也不会由于 无法掉头的原因在目标通道内困住,从而可以保证自移动设备的脱困效果。In the traditional self-moving device control method, if the self-moving device is trapped in a narrow passage, it needs to turn its direction of travel to leave the narrow passage. Problem with devices not being able to leave narrow aisles. However, in this embodiment, after determining that the self-mobile device cannot reverse its traveling direction in the target passage, the self-mobile device is controlled to reverse to exit the target passage. At this time, even if the mobile device is non-circular, it will not be due to The reason why it is impossible to turn around is trapped in the target channel, so that the escape effect of self-moving equipment can be guaranteed.
下面对该自移动设备的控制方法进行介绍。下述实施例以该方法的执行主体为图1所示的自移动设备为例进行说明。The method for controlling the self-mobile device will be introduced below. The following embodiments are described by taking the self-mobile device shown in FIG. 1 as an example for executing the method.
图2是本申请一个实施例提供的自移动设备的控制方法的流程图,该方法至少包括以下几个步骤:Fig. 2 is a flow chart of a method for controlling a self-mobile device provided by an embodiment of the present application, and the method includes at least the following steps:
步骤201,控制自移动设备在目标通道内行进,目标通道是指通道间距大于最小距离、且小于最大距离的通道。Step 201, control the self-mobile device to travel in a target channel, where the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance.
在一个示例中,控制自移动设备在目标通道内行进之前,包括:获取自移动设备在行进方向上的环境信息;基于环境信息确定行进方向上是否存在通道;在存在通道的情况下,基于环境信息获取通道的通道间距;在通道间距大于最小距离、且小于最大距离的情况下,控制自移动设备在目标通道内行进。In an example, before the self-mobile device is controlled to travel in the target channel, it includes: acquiring environment information from the mobile device in the direction of travel; determining whether there is a channel in the direction of travel based on the environment information; The channel spacing of the information acquisition channel; when the channel spacing is greater than the minimum distance and smaller than the maximum distance, control the self-mobile device to travel in the target channel.
在通道间距小于最小距离的情况下,确定行进方向上不存在目标通道,并控制自移动设备调转行进方向,以向远离通道的方向行进。When the channel distance is smaller than the minimum distance, it is determined that there is no target channel in the traveling direction, and the mobile device is controlled to reverse the traveling direction so as to travel in a direction away from the channel.
在通道间距大于最大距离的情况下,确定行进方向上不存在目标通道,控制自移动设备进入通道,在通道内进行行进,并在无法通过该通道的情况下,掉头退出通道。When the passage distance is greater than the maximum distance, determine that there is no target passage in the direction of travel, control the self-mobile device to enter the passage, travel in the passage, and turn around to exit the passage if it cannot pass through the passage.
自移动设备上设置有第一传感器,第一传感器用于采集自移动设备在行进方向上的环境信息,自移动设备获取第一传感器采集到的环境信息。The mobile device is provided with a first sensor, the first sensor is used to collect environmental information of the mobile device in a traveling direction, and the mobile device obtains the environmental information collected by the first sensor.
示意性地,环境信息包括点云数据或环境图像;相应地,基于环境信息确定行进方向上是否存在通道,包括:对环境信息进行目标识别,得到目标识别结果,该目标识别结果用于指示环境信息中是否存在通道。Schematically, the environmental information includes point cloud data or environmental images; correspondingly, determining whether there is a channel in the direction of travel based on the environmental information includes: performing target recognition on the environmental information to obtain a target recognition result, which is used to indicate the environment Whether the channel exists in the message.
其中,对环境信息进行目标识别的算法包括但不限于:神经网络识别、特征识别、图像分割识别等,本实施例不对目标识别的算法作限定。Wherein, the target recognition algorithm for environmental information includes but not limited to: neural network recognition, feature recognition, image segmentation recognition, etc., and this embodiment does not limit the target recognition algorithm.
在存在通道的情况下,基于环境信息获取通道的通道间距,包括:基于环境信息确定通道两侧位置,基于通道两侧位置确定通道间距。If there is a channel, acquiring the channel spacing of the channel based on the environmental information includes: determining the positions on both sides of the channel based on the environmental information, and determining the channel spacing based on the positions on both sides of the channel.
在其它实现方式中,目标识别结果也可以包括通道间距,本实施例不 对通道间距的获取方式作限定。In other implementations, the target recognition result may also include channel spacing, which is not included in this embodiment Limit the way to obtain the channel spacing.
在另一个示例中,控制自移动设备在目标通道内行进之前,包括:响应于控制指令,控制自移动设备在目标通道内行进。此时,清洁设备与控制设备通信相连,控制设备用于控制自移动设备的移动。控制设备可以为遥控器、手机、平板电脑、可穿戴式设备等,本实施例不对控制设备的设备类型作限定。In another example, before controlling the self-mobile device to travel in the target channel, includes: controlling the self-mobile device to travel in the target channel in response to a control instruction. At this time, the cleaning device is connected in communication with the control device, and the control device is used to control the movement of the mobile device. The control device may be a remote controller, a mobile phone, a tablet computer, a wearable device, etc., and this embodiment does not limit the type of the control device.
可选地,自移动设备在目标通道内行进时,整体沿目标通道的中间位置行进。其中,中间位置是自移动设备基于目标通道的通道间距确定的。具体地,中间位置为通道间距的1/2。Optionally, when the self-mobile device travels in the target passage, the whole travels along the middle position of the target passage. Wherein, the intermediate position is determined from the mobile device based on the channel spacing of the target channel. Specifically, the middle position is 1/2 of the channel pitch.
由于目标通道内可能存在障碍物阻碍自移动设备移动。基于此,为了避免自移动设备困在目标通道内,自移动设备在目标通道内行进过程中需确定是否能继续通过目标通道。其中,自移动设备确定是否能继续通过目标通道包括但不限于以下两种方式:Because there may be obstacles in the target channel that hinder the movement of the self-mobile device. Based on this, in order to prevent the self-mobile device from being trapped in the target channel, it is necessary to determine whether the self-mobile device can continue to pass through the target channel during the process of traveling in the target channel. Among them, determining whether the mobile device can continue to pass through the target channel includes but is not limited to the following two methods:
第一种,基于自移动设备在行进过程中发生碰撞的次数,确定自移动设备是否能够通过目标通道。The first one is to determine whether the self-mobile device can pass through the target channel based on the number of times the self-mobile device collides during the traveling process.
相应地,自移动设备上设置有碰撞传感器,以采集自移动设备在行进过程中是否发生碰撞。其中,基于自移动设备在行进过程中发生碰撞的次数,确定自移动设备是否能够通过目标通道,包括:在发生碰撞的次数达到预设次数阈值的情况下,确定自移动设备不能通过目标通道;在发生碰撞的次数小于预设次数阈值的情况下,若自移动设备与通道左侧发生碰撞,则控制自移动设备向右侧偏移预设角度后继续向前行进,若自移动设备与通道右侧发生碰撞,则控制自动设备向左侧偏移预设角度后继续向前行进。Correspondingly, a collision sensor is provided on the self-mobile device to collect whether the self-mobile device collides during travel. Wherein, determining whether the self-mobile device can pass through the target channel based on the number of times the self-mobile device collides during the traveling process includes: determining that the self-mobile device cannot pass the target channel when the number of collisions occurs reaches a preset threshold; When the number of collisions is less than the preset number of thresholds, if the self-mobile device collides with the left side of the channel, the mobile device will be controlled to shift to the right by a preset angle and continue to move forward. When a collision occurs on the right side, the automatic equipment is controlled to shift to the left by a preset angle and continue to move forward.
其中,预设角度预存在自移动设备中,预设角度可以为5°、10°等,本实施例不对预设角度的取值作限定。Wherein, the preset angle is pre-stored in the self-mobile device, and the preset angle may be 5°, 10°, etc., and this embodiment does not limit the value of the preset angle.
在其它实施方式中,向右偏移的预设角度与向左偏移的预设角度也可以不同,本实施例不对自移动设备偏移角度的方式作限定。In other implementation manners, the preset angle of offset to the right and the preset angle of offset to the left may also be different, and this embodiment does not limit the way of offsetting the angle from the mobile device.
由于自移动设备在目标通道内行进方向上可能会发生多次碰撞,此时,基于碰撞次数确定自移动设备是否能继续在目标通道内行进,可以避免自 移动设备在目标通道内无限次碰撞,导致自移动设备困在目标通道内的问题。Since the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid self-moving problems. Mobile device collides infinitely in the target channel, causing self-mobile device to be stuck in the target channel.
第二种,基于自移动设备的设备状态,确定自移动设备是否能够通过目标通道。The second type is to determine whether the self-mobile device can pass through the target channel based on the device state of the self-mobile device.
在一个示例中,设备状态包括自移动设备的剩余电量。相应地,基于自移动设备的设备状态,确定自移动设备是否能够通过目标通道,包括:在自移动设备的剩余电量小于或等于预设电量阈值的情况下,确定自移动设备不能通过目标通道;在自移动设备的剩余电量大于预设电量阈值的情况下,再次获取自移动设备的剩余电量,以将剩余电量与预设电量阈值进行比较。In one example, the device status includes remaining battery power from the mobile device. Correspondingly, based on the device status of the self-mobile device, determining whether the self-mobile device can pass through the target channel includes: determining that the self-mobile device cannot pass through the target channel when the remaining power of the self-mobile device is less than or equal to a preset power threshold; In the case that the remaining power of the mobile device is greater than the preset power threshold, the remaining power of the mobile device is acquired again, so as to compare the remaining power with the preset power threshold.
本示例中,通过在剩余电量较低时,确定自移动设备不能通过目标通道,可以防止自移动设备因电量不足导致不能离开目标通道,从而导致自移动设备不能完成清洁工作的问题。In this example, by determining that the self-mobile device cannot pass through the target channel when the remaining power is low, the problem that the self-mobile device cannot leave the target channel due to insufficient power can be prevented, resulting in the self-mobile device being unable to complete the cleaning work.
在另一个示例中,以自移动设备为清洁设备为例,清洁设备上设置有脏污传感器,脏污传感器用于获取清洁机构的脏污程度,设备状态包括自移动设备清洁机构的脏污程度。相应地,基于自移动设备的设备状态,确定自移动设备是否能够通过目标通道,包括:在自移动设备清洁机构的脏污程度大于预设脏污程度阈值的情况下,确定自移动设备不能通过目标通道;在自移动设备清洁机构的脏污程度小于或等于预设脏污程度阈值的情况下,再次获取自移动设备清洁机构的脏污程度,以将脏污程度与预设脏污程度阈值进行比较。In another example, taking the self-moving device as a cleaning device as an example, the cleaning device is provided with a dirt sensor, which is used to obtain the degree of dirt of the cleaning mechanism, and the state of the device includes the degree of dirt of the cleaning mechanism of the self-moving device . Correspondingly, based on the device state of the self-moving device, determining whether the self-moving device can pass through the target channel includes: determining that the self-moving device cannot pass through when the degree of dirtiness of the cleaning mechanism of the self-moving device is greater than a preset dirtiness threshold Target channel; when the degree of dirtiness from the cleaning mechanism of the mobile device is less than or equal to the preset threshold value of the degree of dirtiness, obtain the degree of dirtiness from the cleaning mechanism of the mobile device again, so as to compare the degree of dirtiness with the preset threshold value of the degree of dirtiness Compare.
本示例中,通过在清洁机构脏污程度较高时,确定自移动设备不能通过目标通道,可以防止自移动设备因清洁机构脏污程度高,导致不能在目标通道内达到预期清洁效果的问题,从而保证了自移动设备的清洁效率。In this example, by determining that the self-moving device cannot pass through the target channel when the cleaning mechanism is highly dirty, it is possible to prevent the problem that the self-moving device cannot achieve the expected cleaning effect in the target channel due to the high degree of dirt of the cleaning mechanism. Thereby ensuring the cleaning efficiency of self-moving equipment.
步骤202,在确定出自移动设备无法通过目标通道的情况下,控制自移动设备倒退,以退出目标通道。Step 202, if it is determined that the mobile device cannot pass through the target channel, control the mobile device backwards to exit the target channel.
可选地,自移动设备在行进方向中驱动件以第一方向运行,以驱动轮体运行,并在目标通道内行进。相应地,在无法在目标通道内继续行进的 情况下,控制自移动设备倒退,包括:控制器控制驱动件以第二方向运行,以驱动轮体带动自移动设备倒退,第二方向与第一方向相反。Optionally, in the traveling direction of the self-moving device, the driving member runs in the first direction to drive the wheel body to run in the target channel. Correspondingly, if it is impossible to continue in the target channel In this case, controlling the self-moving device to reverse includes: the controller controls the driving member to run in a second direction, and the driving wheel body drives the self-mobile device to reverse, and the second direction is opposite to the first direction.
基于上述驱动原理可知,本实施例中的倒退是指:控制器控制驱动件以与前进方向的反方向运行,从而实现自移动设备的倒退,此时,即使自移动设备为非圆形,也不会由于无法掉头的原因在目标通道内困住,从而可以保证自移动设备的脱困效果。Based on the above driving principle, it can be known that the reverse in this embodiment refers to: the controller controls the driving member to run in the opposite direction to the forward direction, so as to realize the reverse of the self-moving device. At this time, even if the self-moving device is non-circular, it can It will not be trapped in the target channel due to the inability to turn around, so that the escape effect of self-moving equipment can be guaranteed.
可选地,控制自移动设备倒退,包括:获取目标通道的中间位置;控制自移动设备按照中间位置倒退。Optionally, controlling the self-mobile device to reverse includes: acquiring an intermediate position of the target channel; controlling the self-mobile device to reverse according to the intermediate position.
由于目标通道的中间位置在行进过程中已被记录,因此,通过读取行进过程的历史记录即可得到目标通道的中间位置。Since the middle position of the target channel has been recorded during the traveling process, the middle position of the target channel can be obtained by reading the historical records of the traveling process.
或者,自移动设备倒退过程中,也可以由第一传感器采集目标通道的环境信息,基于环境信息确定目标通道的通道间距;基于该通道间距确定中间位置。Alternatively, in the process of moving backwards from the mobile device, the first sensor may collect environmental information of the target channel, determine the channel distance of the target channel based on the environmental information, and determine the intermediate position based on the channel distance.
其中,控制自移动设备按照中间位置进行倒退,包括:获取自移动设备倒退方向;确定倒退方向与预设方向之间的夹角是否大于角度阈值;在夹角大于角度阈值的情况下,对倒退方向进行矫正,以使倒退方向与预设方向之间的夹角小于或等于角度阈值。Wherein, controlling the self-mobile device to reverse according to the middle position includes: acquiring the self-mobile device's reverse direction; determining whether the included angle between the reversed direction and the preset direction is greater than the angle threshold; The direction is corrected so that the angle between the reverse direction and the preset direction is less than or equal to the angle threshold.
其中,预设方向平行于目标通道的中间线。Wherein, the preset direction is parallel to the middle line of the target channel.
由于在倒退过程中,自移动设备自身的机身位置可能发生较大偏移,从而与目标通道两侧发生碰撞,此时通过矫正机身位置,并对倒退方向进行矫正,可以避免自移动设备发生较大偏移,减少与目标通道两侧的碰撞。Since the body position of the self-moving device itself may deviate greatly during the reverse process, thus colliding with both sides of the target channel, at this time, by correcting the position of the body and correcting the reverse direction, the self-moving device can be avoided. A large offset occurs to reduce collisions with the sides of the target channel.
在其它实施例中,自移动设备也可以按照行进路线倒退,此时,自移动设备中存储有行进路线。In other embodiments, the self-mobile device may also go backwards according to the travel route, and at this time, the self-mobile device stores the travel route.
可选地,在控制自移动设备按照中间位置倒退之后,还包括下述步骤S1和S2:Optionally, after the mobile device is controlled to reverse according to the middle position, the following steps S1 and S2 are also included:
步骤S1,在自移动设备发生碰撞的情况下,基于碰撞位置调整倒退方向。Step S1, in the case of a collision with the self-mobile device, adjust the reverse direction based on the location of the collision.
可选地,将倒退方向向远离碰撞位置的方向调整预设角度,得到调整 后的倒退方向。Optionally, the reverse direction is adjusted to a preset angle away from the collision position to obtain an adjusted backward direction.
示意性地,自移动设备设置有碰撞传感器,当检测到发生碰撞后,将倒退方向朝向远离碰撞发生的方向调整预设角度,得到调整后的倒退方向。Schematically, the self-mobile device is provided with a collision sensor, and when a collision is detected, the reverse direction is adjusted to a preset angle away from the direction where the collision occurs to obtain the adjusted reverse direction.
其中,预设角度预存在自移动设备中,预设角度可以为5°、10°等,本实施例不对预设角度的取值作限定。Wherein, the preset angle is pre-stored in the self-mobile device, and the preset angle may be 5°, 10°, etc., and this embodiment does not limit the value of the preset angle.
可选地,在基于碰撞位置调整倒退方向之前,即在步骤S1之前还包括:记录自移动设备在倒退过程中发生碰撞的次数;在次数达到次数阈值的情况下,输出告警提示或执行预设脱困动作。Optionally, before adjusting the reversing direction based on the collision position, that is, before step S1, it also includes: recording the number of collisions in the reversing process from the mobile device; when the number of times reaches the number threshold, output a warning prompt or execute a preset escape action.
可选地,告警提示可以为自移动设备自身发出告警提示语音,或者向与自移动设备绑定的移动端发送告警提示,本实施例不对告警提示的输出方式作限定。Optionally, the alarm prompt can be the alarm prompt voice issued by the self-mobile device itself, or the alarm prompt is sent to the mobile terminal bound with the self-mobile device. This embodiment does not limit the output mode of the alarm prompt.
由于自移动设备在倒退过程中可能会遇到可移动的障碍物,此时可以通过输出告警提示以告知用户存在障碍物,以使用户及时将障碍物移除,或者将自移动设备搬离,从而避免自移动设备被困。Since the self-mobile device may encounter a movable obstacle in the process of reversing, at this time, an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device away, Thus avoiding being trapped from mobile devices.
可选地,预设脱困动作包括:将倒退的驱动功率调节至最大功率;按照最大功率倒退;或者,控制自移动设备前进一定距离后,将倒退的驱动功率调节至最大功率;按照最大功率倒退。Optionally, the preset escape action includes: adjusting the reverse drive power to the maximum power; reverse according to the maximum power; or, after controlling the mobile device to advance a certain distance, adjust the reverse drive power to the maximum power; reverse according to the maximum power .
由于自移动设备在倒退过程中在某位置遇到的障碍物,可能是自移动设备经过该位置后被移动至该位置的障碍物。此时,障碍物可移动的概率较大。此时,通过加大功率撞开该障碍物的概率较大,可以避免自移动设备在倒退过程中被困的问题。The obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
步骤S2,控制自移动设备按照调整后的倒退方向倒退。Step S2, controlling the self-mobile device to reverse according to the adjusted reverse direction.
综上所述,本实施例提供的自移动设备的控制方法,通过控制自移动设备在目标通道内行进,目标通道是指通道间距大于最小距离、且小于最大距离的通道;在确定出自移动设备无法通过目标通道的情况下,控制自移动设备倒退,以退出目标通道。可以解决自移动设备可能无法在窄通道内实现方向调转,会导致自移动设备无法离开窄通道的问题。通过确定自移动设备无法在目标通道内调转行进方向后,控制自移动设备倒退以退出 目标通道。此时,即使自移动设备为非圆形,也不会由于无法掉头的原因在目标通道内困住,从而可以保证自移动设备的脱困效果。To sum up, the control method of the self-moving device provided in this embodiment controls the self-mobile device to travel in the target channel, and the target channel refers to a channel whose distance between channels is greater than the minimum distance and smaller than the maximum distance; In the event that the target channel cannot be passed, the control rewinds from the mobile device to exit the target channel. It can solve the problem that the self-mobile device may not be able to achieve direction reversal in the narrow passage, which will cause the self-mobile device to be unable to leave the narrow passage. Exit by controlling the self-mobile device to reverse direction of travel after determining that the self-mobile device cannot reverse the direction of travel within the target lane target channel. At this time, even if the self-moving device is non-circular, it will not be trapped in the target channel due to the inability to turn around, so that the self-moving device's escape effect can be guaranteed.
另外,由于自移动设备在目标通道内行进方向上可能会发生多次碰撞,此时,基于碰撞次数确定自移动设备是否能继续在目标通道内行进,可以避免自移动设备在目标通道内无限次碰撞,导致自移动设备困在目标通道内的问题。In addition, since the self-mobile device may have multiple collisions in the direction of travel in the target channel, at this time, determining whether the self-mobile device can continue to travel in the target channel based on the number of collisions can avoid infinite times of self-mobile devices in the target channel. Collision, a problem that causes mobile devices to get stuck in the target lane.
另外,通过在剩余电量较低时,确定自移动设备不能通过目标通道,可以防止自移动设备因电量不足导致不能离开目标通道,从而导致自移动设备不能完成清洁工作的问题。In addition, by determining that the self-moving device cannot pass through the target passage when the remaining power is low, it is possible to prevent the self-moving device from being unable to leave the target passage due to insufficient power, thereby causing the self-moving device to fail to complete the cleaning work.
另外,通过在清洁机构脏污程度较高时,确定自移动设备不能通过目标通道,可以防止自移动设备因清洁机构脏污程度高,导致不能在目标通道内达到预期清洁效果的问题,从而保证了自移动设备的清洁效率。In addition, by determining that the self-moving device cannot pass through the target channel when the cleaning mechanism is highly dirty, it is possible to prevent the problem that the self-moving device cannot achieve the expected cleaning effect in the target channel due to the high degree of dirt of the cleaning mechanism, thereby ensuring Improved cleaning efficiency from mobile equipment.
另外,由于在倒退过程中,自移动设备自身的机身位置可能发生较大偏移,从而与目标通道两侧发生碰撞,此时通过矫正机身位置,并对倒退方向进行矫正,可以避免自移动设备发生较大偏移,减少与目标通道两次的碰撞。In addition, during the process of reversing, the position of the self-mobile device itself may deviate greatly, thus colliding with both sides of the target channel. The mobile device has a large offset, reducing the collision with the target channel twice.
另外,由于自移动设备在倒退过程中可能会遇到可移动的障碍物,此时可以通过输出告警提示以告知用户存在障碍物,以使用户及时将障碍物移除,或者将自移动设备搬离,从而避免自移动设备被困。In addition, since the self-mobile device may encounter movable obstacles in the process of reversing, at this time, an alarm prompt can be output to inform the user of the existence of the obstacle, so that the user can remove the obstacle in time, or move the self-mobile device back. to avoid being trapped from your mobile device.
另外,由于自移动设备在倒退过程中在某位置遇到的障碍物,可能是自移动设备经过该位置后被移动至该位置的障碍物。此时,障碍物可移动的概率较大。此时,通过加大功率撞开该障碍物的概率较大,可以避免自移动设备在倒退过程中被困的问题。In addition, the obstacle encountered by the self-mobile device at a certain position during the reverse process may be an obstacle moved to the position after the self-mobile device passes through the position. At this time, the probability of the obstacle being movable is high. At this time, by increasing the power, the probability of knocking over the obstacle is higher, which can avoid the problem that the self-mobile device is trapped during the backward process.
图3时本申请一个实施例提供的自移动设备控制装置的框图,本实施例以该装置应用于图1所示的自移动设备中为例进行说明。该装置至少包括以下几个模块:行进模块310和倒退模块320。FIG. 3 is a block diagram of a self-moving device control device provided by an embodiment of the present application. This embodiment is described by taking the device applied to the self-moving device shown in FIG. 1 as an example. The device at least includes the following modules: a forward module 310 and a reverse module 320 .
行进模块310,用于控制自移动设备在目标通道内行进,目标通道是指 通道间距大于最小距离、且小于最大距离的通道;The traveling module 310 is used to control the self-mobile device to travel in the target channel, and the target channel refers to Channels whose channel spacing is greater than the minimum distance and less than the maximum distance;
倒退模块320,用于在确定出自移动设备无法通过目标通道的情况下,控制自移动设备倒退,以退出目标通道。The reversing module 320 is configured to control the ego mobile device to regress to exit the target passage when it is determined that the ego mobile device cannot pass through the target passage.
相关细节参考上述实施例。Relevant details refer to the above-mentioned examples.
需要说明的是:上述实施例中提供的自移动设备控制装置在进行控制时,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将自移动设备控制装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。另外,上述实施例提供的自移动设备控制装置与自移动设备控制方法实施例属于同一构思,其具体实现过程详见方法实施例,这里不再赘述。It should be noted that: when the self-mobile device control device provided in the above-mentioned embodiments performs control, the division of the above-mentioned functional modules is used as an example for illustration. In practical applications, the above-mentioned functions can be assigned to different functional modules according to needs. To complete means to divide the internal structure of the mobile device control device into different functional modules, so as to complete all or part of the functions described above. In addition, the apparatus for controlling self-moving equipment provided in the above-mentioned embodiments and the embodiment of the method for controlling self-moving equipment belong to the same concept, and its specific implementation process is detailed in the method embodiment, and will not be repeated here.
本实施例提供一种电子设备,如图4所示,该电子设备可以为图1中的自移动设备。该电子设备至少包括处理器401和存储器402。This embodiment provides an electronic device, as shown in FIG. 4 , the electronic device may be the self-moving device in FIG. 1 . The electronic device includes at least a processor 401 and a memory 402 .
处理器401可以包括一个或多个处理核心,比如:4核心处理器、8核心处理器等。处理器401可以采用DSP(Digital Signal Processing,数字信号处理)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)、PLA(Programmable Logic Array,可编程逻辑阵列)中的至少一种硬件形式来实现。处理器401也可以包括主处理器和协处理器,主处理器是用于对在唤醒状态下的数据进行处理的处理器,也称CPU(Central Processing Unit,中央处理器);协处理器是用于对在待机状态下的数据进行处理的低功耗处理器。在一些实施例中,处理器401可以在集成有GPU(Graphics Processing Unit,图像处理器),GPU用于负责显示屏所需要显示的内容的渲染和绘制。一些实施例中,处理器401还可以包括AI(Artificial Intelligence,人工智能)处理器,该AI处理器用于处理有关机器学习的计算操作。The processor 401 may include one or more processing cores, such as a 4-core processor, an 8-core processor, and the like. Processor 401 can adopt at least one hardware form in DSP (Digital Signal Processing, digital signal processing), FPGA (Field-Programmable Gate Array, field programmable gate array), PLA (Programmable Logic Array, programmable logic array) accomplish. Processor 401 may also include a main processor and a coprocessor, and the main processor is a processor for processing data in a wake-up state, also known as a CPU (Central Processing Unit, central processing unit); the coprocessor is Low-power processor for processing data in standby state. In some embodiments, the processor 401 may be integrated with a GPU (Graphics Processing Unit, image processor), and the GPU is used for rendering and drawing the content that needs to be displayed on the display screen. In some embodiments, the processor 401 may also include an AI (Artificial Intelligence, artificial intelligence) processor, where the AI processor is used to process computing operations related to machine learning.
存储器402可以包括一个或多个计算机可读存储介质,该计算机可读存储介质可以是非暂态的。存储器402还可包括高速随机存取存储器,以及非易失性存储器,比如一个或多个磁盘存储设备、闪存存储设备。在一 些实施例中,存储器402中的非暂态的计算机可读存储介质用于存储至少一个指令,该至少一个指令用于被处理器401所执行以实现本申请中方法实施例提供的自移动设备控制方法。Memory 402 may include one or more computer-readable storage media, which may be non-transitory. The memory 402 may also include high-speed random access memory and non-volatile memory, such as one or more magnetic disk storage devices and flash memory storage devices. In a In some embodiments, the non-transitory computer-readable storage medium in the memory 402 is used to store at least one instruction, and the at least one instruction is used to be executed by the processor 401 to realize the self-mobile device provided by the method embodiments in this application Control Method.
在一些实施例中,电子设备还可选包括有:外围设备接口和至少一个外围设备。处理器401、存储器402和外围设备接口之间可以通过总线或信号线相连。各个外围设备可以通过总线、信号线或电路板与外围设备接口相连。示意性地,外围设备包括但不限于:射频电路、触摸显示屏、音频电路、和电源等。In some embodiments, the electronic device may optionally further include: a peripheral device interface and at least one peripheral device. The processor 401, the memory 402, and the peripheral device interface may be connected through a bus or a signal line. Each peripheral device can be connected with the peripheral device interface through a bus, a signal line or a circuit board. Schematically, peripheral devices include but are not limited to: radio frequency circuits, touch screens, audio circuits, and power supplies.
当然,电子设备还可以包括更少或更多的组件,本实施例对此不作限定。Of course, the electronic device may also include fewer or more components, which is not limited in this embodiment.
可选地,本申请还提供有一种计算机可读存储介质,计算机可读存储介质中存储有程序,程序由处理器加载并执行以实现上述方法实施例的自移动设备控制方法。Optionally, the present application also provides a computer-readable storage medium, where a program is stored in the computer-readable storage medium, and the program is loaded and executed by a processor to implement the self-mobile device control method of the foregoing method embodiment.
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-mentioned embodiments can be combined arbitrarily. To make the description concise, all possible combinations of the technical features in the above-mentioned embodiments are not described. However, as long as there is no contradiction in the combination of these technical features, should be considered as within the scope of this specification.
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。 The above-mentioned embodiments only represent several implementation modes of the present application, and the description thereof is relatively specific and detailed, but it should not be construed as limiting the scope of the patent for the invention. It should be noted that those skilled in the art can make several modifications and improvements without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the scope of protection of the patent application should be based on the appended claims.

Claims (14)

  1. 一种自移动设备的控制方法,其特征在于,所述自移动设备不相邻边缘部分之间的最小距离与不相邻边缘部分之间的最大距离不等;所述方法包括:A method for controlling self-moving equipment, characterized in that the minimum distance between non-adjacent edge portions of the self-moving equipment is not equal to the maximum distance between non-adjacent edge portions; the method includes:
    控制所述自移动设备在目标通道内行进,所述目标通道是指通道间距大于所述最小距离、且小于所述最大距离的通道;controlling the self-moving device to travel in a target channel, where the target channel refers to a channel whose channel spacing is greater than the minimum distance and smaller than the maximum distance;
    在确定出所述自移动设备无法通过所述目标通道的情况下,控制所述自移动设备倒退,以退出所述目标通道。When it is determined that the self-moving device cannot pass through the target channel, controlling the self-mobile device to reverse to exit the target channel.
  2. 根据权利要求1所述的方法,其特征在于,所述自移动设备包括轮体、以及与所述轮体相连的驱动件;所述自移动设备在行进过程中,所述驱动件以第一方向运行,以驱动所述轮体运动;The method according to claim 1, wherein the self-moving device comprises a wheel body and a driving member connected to the wheel body; during the traveling process of the self-moving device, the driving member uses a first direction to drive the wheel body to move;
    所述控制所述自移动设备倒退,包括:The controls for reversing from the mobile device include:
    控制所述驱动件以第二方向运行,以驱动所述轮体带动所述自移动设备倒退,所述第二方向与所述第一方向相反。The driving member is controlled to run in a second direction to drive the wheel body to drive the self-moving device backward, and the second direction is opposite to the first direction.
  3. 根据权利要求1所述的方法,其特征在于,所述控制所述自移动设备倒退,包括:The method according to claim 1, wherein the controlling the self-mobile device to go backwards comprises:
    获取所述目标通道的中间位置;Obtain the middle position of the target channel;
    控制所述自移动设备按照所述中间位置倒退。Controlling the self-mobile device to reverse according to the intermediate position.
  4. 根据权利要求2所述的方法,其特征在于,所述控制所述自移动设备按照所述中间位置倒退之后,还包括:The method according to claim 2, wherein after the controlling the self-mobile device to reverse according to the intermediate position, further comprising:
    在所述自移动设备发生碰撞的情况下,基于碰撞位置调整倒退方向;In the event that the self-mobile device collides, adjusting a reverse direction based on the collision location;
    控制所述自移动设备按照调整后的倒退方向倒退。Controlling the self-mobile device to reverse according to the adjusted reverse direction.
  5. 根据权利要求4所述的方法,其特征在于,所述控制所述自移动设备按照调整后的倒退方向倒退,包括;The method according to claim 4, wherein the controlling the self-mobile device to reverse according to the adjusted reverse direction comprises;
    将所述倒退方向向远离所述碰撞位置的方向调整预设角度,得到所述调整后的倒退方向。Adjusting the reverse direction to a direction away from the collision position by a preset angle to obtain the adjusted reverse direction.
  6. 根据权利要求4所述的方法,其特征在于,所述基于碰撞位置调整倒退方向之前,还包括:The method according to claim 4, characterized in that before adjusting the reverse direction based on the collision position, further comprising:
    记录所述自移动设备在倒退过程中发生碰撞的次数;Recording the number of times that the self-mobile device collides during the backward process;
    在所述次数达到次数阈值的情况下,输出告警提示或执行预设脱困动作。 When the number of times reaches the number threshold, an alarm prompt is output or a preset escape action is executed.
  7. 根据权利要求6所述的方法,其特征在于,所述预设脱困动作包括:The method according to claim 6, wherein the preset escape action includes:
    将倒退的驱动功率调节至最大功率;按照所述最大功率倒退;Regulate the driving power of reverse to the maximum power; reverse according to the maximum power;
    或者,or,
    控制所述自移动设备前进一定距离后,将倒退的驱动功率调节至最大功率;按照所述最大功率倒退。After controlling the self-moving device to advance a certain distance, adjust the reverse drive power to the maximum power; reverse according to the maximum power.
  8. 根据权利要求2所述的方法,其特征在于,所述控制所述自移动设备按照所述中间位置倒退,包括:The method according to claim 2, wherein the controlling the self-mobile device to reverse according to the intermediate position comprises:
    获取所述自移动设备倒退方向;Obtain the reverse direction from the mobile device;
    确定所述倒退方向与预设方向之间的夹角是否大于角度阈值;所述预设方向平行于所述目标通道的中间线;determining whether the included angle between the reverse direction and a preset direction is greater than an angle threshold; the preset direction is parallel to the middle line of the target channel;
    在所述夹角大于角度阈值的情况下,对所述倒退方向进行矫正,以使所述倒退方向与所述预设方向之间的夹角小于或等于所述角度阈值。If the included angle is greater than an angle threshold, the reverse direction is corrected so that the included angle between the reverse direction and the preset direction is smaller than or equal to the angle threshold.
  9. 根据权利要求1所述方法,其特征在于,所述控制所述自移动设备在目标通道内行进之后,还包括:The method according to claim 1, wherein after the controlling the self-mobile device to travel in the target channel, further comprising:
    基于所述自移动设备在行进过程中发生碰撞的次数,确定所述自移动设备是否能够通过所述目标通道;determining whether the self-moving device can pass through the target channel based on the number of times the self-moving device collides during travel;
    或者,or,
    基于所述自移动设备的设备状态,确定所述自移动设备是否能够通过所述目标通道。Based on the device state of the self-moving device, it is determined whether the self-moving device can pass through the target channel.
  10. 根据权利要求9所述方法,其特征在于,所述基于所述自移动设备的设备状态,确定所述自移动设备是否能够通过所述目标通道,包括:The method according to claim 9, wherein the determining whether the self-mobile device can pass through the target channel based on the device state of the self-mobile device comprises:
    在自移动设备的剩余电量小于或等于预设电量阈值的情况下,确定自移动设备不能通过目标通道。When the remaining power of the mobile device is less than or equal to the preset power threshold, it is determined that the mobile device cannot pass through the target channel.
  11. 根据权利要求9所述方法,其特征在于,所述基于所述自移动设备的设备状态,确定所述自移动设备是否能够通过所述目标通道,包括:The method according to claim 9, wherein the determining whether the self-mobile device can pass through the target channel based on the device state of the self-mobile device comprises:
    在自移动设备清洁机构的脏污程度大于预设脏污程度阈值的情况下,确定自移动设备不能通过目标通道。In a case where the degree of dirtiness of the self-moving device cleaning mechanism is greater than a preset dirt degree threshold, it is determined that the self-moving device cannot pass through the target channel.
  12. 根据权利要求1所述的方法,其特征在于,所述控制所述自移动设备在目标通道内行进之前,还包括:The method according to claim 1, wherein before the controlling the self-mobile device to travel in the target channel, further comprising:
    获取所述自移动设备在行进方向上的环境信息; Acquiring environmental information of the self-mobile device in the direction of travel;
    基于所述环境信息确定所述行进方向上是否存在所述通道;determining whether the passage exists in the traveling direction based on the environmental information;
    在存在所述通道的情况下,基于所述环境信息获取所述通道的通道间距;If the channel exists, acquire the channel spacing of the channel based on the environment information;
    在所述通道间距大于所述最小距离、且小于所述最大距离的情况下,控制所述自移动设备在所述目标通道内行进。In the case that the channel distance is greater than the minimum distance and smaller than the maximum distance, the self-moving device is controlled to travel in the target channel.
  13. 一种电子设备,其特征在于,所述设备包括处理器和存储器;所述存储器中存储有程序,所述程序由所述处理器加载并执行以实现如权利要求1-12所述的自移动设备的控制方法。An electronic device, characterized in that the device includes a processor and a memory; a program is stored in the memory, and the program is loaded and executed by the processor to realize self-moving as claimed in claims 1-12 The control method of the device.
  14. 一种计算机可读存储介质,其特征在于,所述存储介质中存储有程序,所述程序被处理器执行时用于实现如权利要求1-12所述的自移动设备的控制方法。 A computer-readable storage medium, wherein a program is stored in the storage medium, and when the program is executed by a processor, the program is used to implement the control method of the mobile device according to claims 1-12.
PCT/CN2023/074694 2022-02-25 2023-02-07 Self-moving device control method, device, and storage medium WO2023160368A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210190809.XA CN116700237A (en) 2022-02-25 2022-02-25 Control method and device of self-mobile device and storage medium
CN202210190809.X 2022-02-25

Publications (1)

Publication Number Publication Date
WO2023160368A1 true WO2023160368A1 (en) 2023-08-31

Family

ID=87764805

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2023/074694 WO2023160368A1 (en) 2022-02-25 2023-02-07 Self-moving device control method, device, and storage medium

Country Status (2)

Country Link
CN (1) CN116700237A (en)
WO (1) WO2023160368A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117282698A (en) * 2023-09-20 2023-12-26 宁夏隆基宁光仪表股份有限公司 Photovoltaic cleaning robot and method for autonomously selecting cleaning route thereof

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003280736A (en) * 2002-03-22 2003-10-02 Matsushita Electric Ind Co Ltd Self-propelled apparatus and its program
JP2009169802A (en) * 2008-01-18 2009-07-30 Panasonic Corp Autonomous traveling device and program
US20130166134A1 (en) * 2010-07-13 2013-06-27 Murata Machinery, Ltd. Autonomous mobile body
CN105739503A (en) * 2016-04-13 2016-07-06 上海物景智能科技有限公司 Turning method of walking robot and control device
CN107536565A (en) * 2017-10-24 2018-01-05 湖南格兰博智能科技有限责任公司 From mobile clean robot and its control method
CN110192814A (en) * 2019-06-20 2019-09-03 深圳市银星智能科技股份有限公司 It gets rid of poverty method and from mobile device from mobile device
CN111090277A (en) * 2018-10-22 2020-05-01 科沃斯机器人股份有限公司 Method, apparatus and storage medium for travel control
CN111208811A (en) * 2018-11-22 2020-05-29 北京奇虎科技有限公司 Narrow-slit escaping method, device and equipment for sweeping robot and readable storage medium
CN111650933A (en) * 2020-05-19 2020-09-11 上海有个机器人有限公司 Control robot escaping method, device, terminal and readable storage medium
CN111714030A (en) * 2019-03-19 2020-09-29 北京奇虎科技有限公司 Method and device for removing difficulty of cleaning equipment, electronic equipment and readable storage medium
CN111802968A (en) * 2020-08-02 2020-10-23 珠海市一微半导体有限公司 Detection and escaping method for judging trapped state of robot
CN112947464A (en) * 2021-03-05 2021-06-11 上海有个机器人有限公司 Method, device, terminal and storage medium for robot to pass through narrow space
CN114510042A (en) * 2022-01-22 2022-05-17 深圳市神州云海智能科技有限公司 Method and system for solving abnormal pause motion of robot narrow channel
CN114518744A (en) * 2020-10-30 2022-05-20 深圳乐动机器人有限公司 Robot escaping method and device, robot and storage medium
CN114521837A (en) * 2022-03-09 2022-05-24 美智纵横科技有限责任公司 Sweeping robot control method and device and sweeping robot
CN115167448A (en) * 2022-07-29 2022-10-11 深圳优地科技有限公司 Robot escaping method and device, robot and storage medium
CN115177186A (en) * 2022-07-21 2022-10-14 美智纵横科技有限责任公司 Sweeping method, sweeping device, sweeping robot and computer readable storage medium

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003280736A (en) * 2002-03-22 2003-10-02 Matsushita Electric Ind Co Ltd Self-propelled apparatus and its program
JP2009169802A (en) * 2008-01-18 2009-07-30 Panasonic Corp Autonomous traveling device and program
US20130166134A1 (en) * 2010-07-13 2013-06-27 Murata Machinery, Ltd. Autonomous mobile body
CN105739503A (en) * 2016-04-13 2016-07-06 上海物景智能科技有限公司 Turning method of walking robot and control device
CN107536565A (en) * 2017-10-24 2018-01-05 湖南格兰博智能科技有限责任公司 From mobile clean robot and its control method
CN111090277A (en) * 2018-10-22 2020-05-01 科沃斯机器人股份有限公司 Method, apparatus and storage medium for travel control
CN111208811A (en) * 2018-11-22 2020-05-29 北京奇虎科技有限公司 Narrow-slit escaping method, device and equipment for sweeping robot and readable storage medium
CN111714030A (en) * 2019-03-19 2020-09-29 北京奇虎科技有限公司 Method and device for removing difficulty of cleaning equipment, electronic equipment and readable storage medium
CN110192814A (en) * 2019-06-20 2019-09-03 深圳市银星智能科技股份有限公司 It gets rid of poverty method and from mobile device from mobile device
CN111650933A (en) * 2020-05-19 2020-09-11 上海有个机器人有限公司 Control robot escaping method, device, terminal and readable storage medium
CN111802968A (en) * 2020-08-02 2020-10-23 珠海市一微半导体有限公司 Detection and escaping method for judging trapped state of robot
CN114518744A (en) * 2020-10-30 2022-05-20 深圳乐动机器人有限公司 Robot escaping method and device, robot and storage medium
CN112947464A (en) * 2021-03-05 2021-06-11 上海有个机器人有限公司 Method, device, terminal and storage medium for robot to pass through narrow space
CN114510042A (en) * 2022-01-22 2022-05-17 深圳市神州云海智能科技有限公司 Method and system for solving abnormal pause motion of robot narrow channel
CN114521837A (en) * 2022-03-09 2022-05-24 美智纵横科技有限责任公司 Sweeping robot control method and device and sweeping robot
CN115177186A (en) * 2022-07-21 2022-10-14 美智纵横科技有限责任公司 Sweeping method, sweeping device, sweeping robot and computer readable storage medium
CN115167448A (en) * 2022-07-29 2022-10-11 深圳优地科技有限公司 Robot escaping method and device, robot and storage medium

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117282698A (en) * 2023-09-20 2023-12-26 宁夏隆基宁光仪表股份有限公司 Photovoltaic cleaning robot and method for autonomously selecting cleaning route thereof

Also Published As

Publication number Publication date
CN116700237A (en) 2023-09-05

Similar Documents

Publication Publication Date Title
US11846950B2 (en) Mobile robot and control method thereof
CN111153300B (en) Ladder taking method and system for robot, robot and storage medium
US10350762B2 (en) Autonomously moving body, movement controlling method, and recording medium storing movement controlling program
WO2023160368A1 (en) Self-moving device control method, device, and storage medium
US20190090711A1 (en) Robot cleaner and control method thereof
WO2021218310A1 (en) Parking method and apparatus, and vehicle
US20220273152A1 (en) Obstacle identification method, apparatus, self-moving device and storage medium
CN109129499B (en) Method for controlling window cleaning robot to walk, window cleaning robot and storage medium
EP3760505A1 (en) Method and apparatus for avoidance control of vehicle, electronic device and storage medium
DE10133006A1 (en) Movable robot system using an RF module
CN113576322B (en) Cleaning method, apparatus and storage medium for cleaning robot
WO2021169964A1 (en) Target detection method and related device
CN109661667A (en) The retrograde detection device of vehicle and method, electronic equipment
KR20190053730A (en) Moving apparatus for cleaning, charging apparatus and method for controlling thereof
CN113442908B (en) Automatic parking path planning method and system and parking control equipment
WO2023098383A1 (en) Cleaning method for cleaning device, cleaning device, and storage medium
JP2004326692A (en) Autonomous travelling robot
US20220280007A1 (en) Mobile robot and method of controlling the same
CN111067430A (en) Control method and device for cleaning robot, cleaning robot and storage medium
US20210264608A1 (en) Information processing method, program, and information processing system
CN113561962B (en) Automatic parking path planning method and system and parking control equipment
WO2023019922A1 (en) Navigation method and self-propelled apparatus
CN107950020B (en) Image recording device
CN114521837A (en) Sweeping robot control method and device and sweeping robot
CN115214635A (en) Obstacle crossing method and device for unmanned vehicle, unmanned vehicle and storage medium

Legal Events

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

Ref document number: 23758993

Country of ref document: EP

Kind code of ref document: A1