CN111338332A - Automatic walking equipment and obstacle avoidance method and device thereof - Google Patents

Automatic walking equipment and obstacle avoidance method and device thereof Download PDF

Info

Publication number
CN111338332A
CN111338332A CN201811456314.7A CN201811456314A CN111338332A CN 111338332 A CN111338332 A CN 111338332A CN 201811456314 A CN201811456314 A CN 201811456314A CN 111338332 A CN111338332 A CN 111338332A
Authority
CN
China
Prior art keywords
light
distance
signal
obstacle
intensity
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
CN201811456314.7A
Other languages
Chinese (zh)
Other versions
CN111338332B (en
Inventor
张晓骏
兰彬财
孙明智
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Positec Power Tools Suzhou Co Ltd
Original Assignee
Positec Power Tools Suzhou Co Ltd
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 Positec Power Tools Suzhou Co Ltd filed Critical Positec Power Tools Suzhou Co Ltd
Priority to CN201811456314.7A priority Critical patent/CN111338332B/en
Priority to PCT/CN2019/116259 priority patent/WO2020108267A1/en
Publication of CN111338332A publication Critical patent/CN111338332A/en
Application granted granted Critical
Publication of CN111338332B publication Critical patent/CN111338332B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

The application discloses automatic walking equipment, and an obstacle avoidance method and device thereof, wherein a light signal is emitted to an obstacle through a light emitting unit; receiving a reflected light signal reflected by the obstacle through the light receiving unit; and detecting whether the intensity of the reflected light signal is within a preset threshold range, and if not, adjusting the intensity of the emitted light signal of the photoelectric sensor. The emitting power is adjusted according to the intensity of the reflected light signal, energy waste caused by the emitting power is avoided, and the accuracy of obstacle detection is improved. The transmitting power is adjusted according to the intensity of the reflected light signal, and the phenomenon that the reflected signal is too weak and is judged mistakenly as having no obstacle due to the fact that the transmitting power is too small is avoided.

Description

Automatic walking equipment and obstacle avoidance method and device thereof
Technical Field
The invention relates to the field of garden processes, in particular to automatic walking equipment, and an obstacle avoidance method and device thereof.
Background
The intelligent mower has an automatic walking function, can automatically finish the lawn trimming work, does not need manual direct control and operation, greatly reduces manual operation, and is a tool suitable for lawn trimming and maintenance in places such as family courtyards and public greenbelts.
Usually, an intelligent mower has an obstacle avoidance function, and one mode is to realize yielding by colliding the mower with an obstacle and using a collision sensor. One is to detect obstacles such as trees by using an ultrasonic sensor or a photoelectric sensor, and when the mower approaches the obstacles, the mower makes an avoiding or detouring action in advance to avoid collision with the obstacles.
In the conventional technology, when the intelligent mower detects the obstacle, the technical problems of energy waste, inaccurate detection result and the like exist.
Disclosure of Invention
Therefore, the automatic walking equipment, the obstacle avoidance method and the obstacle avoidance device can accurately detect whether the obstacle exists or not, and can save energy.
An obstacle avoidance method for automatic walking equipment, wherein the automatic walking equipment is provided with a photoelectric sensor, the photoelectric sensor comprises a light emitting unit and a light receiving unit, and the obstacle avoidance method comprises the following steps:
transmitting a light signal to an obstacle through the light transmitting unit;
receiving a reflected light signal reflected by the obstacle through the light receiving unit;
detecting whether the intensity of the reflected light signal is within a preset threshold range;
if not, the emitted light power of the light emitting unit is adjusted.
In one embodiment, if not, the adjusting the emitted light power of the light emitting unit includes:
if the intensity of the reflected light signal is larger than the maximum value of the threshold value range, reducing the emitted light power of the light emitting unit;
and if the intensity of the reflected light signal is smaller than the minimum value of the threshold range, increasing the emitted light power of the light emitting unit.
In one embodiment, before the detecting whether the intensity of the reflected light signal is within a preset threshold range, the method further includes:
and converting the reflected light signal into a light intensity electric signal and a light energy electric signal, and calculating the intensity of the reflected light signal based on the light intensity electric signal.
In one embodiment, the method further comprises:
and calculating the distance between the automatic walking equipment and the barrier based on the light intensity electric signal and the light energy electric signal, and controlling the operation of the automatic walking equipment.
In one embodiment, the method for calculating the distance between the automatic walking device and the obstacle comprises one or more of the following steps:
calculating a first distance between the barrier and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal;
calculating a second distance between the obstacle and the automatic walking device according to a time difference between the transmitted light signal and the received reflected light signal;
and calculating a third distance between the obstacle and the automatic walking equipment in a triangular distance measurement mode.
The utility model provides an automatic walking equipment keeps away barrier device, automatic walking equipment installs light emission unit and light receiving unit, the device includes:
a transmitting module for transmitting an optical signal to an obstacle through the optical transmitting unit;
the receiving module is used for receiving a reflected light signal reflected by the obstacle through the light receiving unit;
the detection module is used for detecting whether the intensity of the reflected light signal is within a preset threshold range;
and the adjusting module is used for adjusting the transmitting light power of the light transmitting unit if the light transmitting unit does not transmit light.
An automated walking device comprising:
a light emitting unit for emitting a light signal to an obstacle;
a light receiving unit for receiving a reflected light signal reflected by the obstacle;
and the processing unit is connected with the light receiving unit and used for detecting whether the intensity of the reflected light signal is within a preset threshold range or not, and if not, the transmitting light power of the light transmitting unit is adjusted.
In one embodiment, the light receiving unit converts the reflected light signal into an electrical light intensity signal and an electrical light energy signal;
the processing unit is further used for calculating the intensity of the reflected light signal based on the light intensity electric signal.
In one embodiment, the processing unit is further configured to calculate a distance between the automatic walking device and the obstacle based on the light intensity electrical signal and the light energy electrical signal, and control the operation of the automatic walking device.
In one embodiment, the processing unit is configured to calculate the distance of the self-propelled device from the obstacle by one or more of:
calculating a first distance between the barrier and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal;
calculating a second distance between the obstacle and the automatic walking device according to a time difference between the transmitted light signal and the received reflected light signal;
and calculating a third distance between the obstacle and the automatic walking equipment in a triangular distance measurement mode.
In one embodiment, the automatic walking device further comprises a control unit, and the control unit is used for controlling the operation of the automatic walking device according to one or more of the first distance, the second distance and the third distance.
In one embodiment, the optical signal transmitting unit and the optical receiving unit are integrated on the same photosensor.
In one embodiment, the optical signal transmitting unit comprises one photosensor, and the optical signal receiving unit comprises at least two photosensors.
The automatic walking equipment, the obstacle avoidance method and the obstacle avoidance device transmit light signals to the obstacle through the light emitting unit; receiving a reflected light signal reflected by the obstacle through the light receiving unit; and detecting whether the intensity of the reflected light signal is within a preset threshold range, and if not, adjusting the intensity of the emitted light signal of the photoelectric sensor. The emitting power is adjusted according to the intensity of the reflected light signal, energy waste caused by the emitting power is avoided, and the accuracy of obstacle detection is improved. The transmitting power is adjusted according to the intensity of the reflected light signal, and the phenomenon that the reflected signal is too weak and is judged mistakenly as having no obstacle due to the fact that the transmitting power is too small is avoided.
Drawings
Fig. 1 is a schematic flow chart of an obstacle avoidance method of an automatic walking device in one embodiment;
fig. 2 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 3 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 4 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 5 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 6 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 7 is a schematic flow chart of an obstacle avoidance method of the automatic walking device in one embodiment;
fig. 8 is a block diagram of an obstacle avoidance device of the automatic walking apparatus in one embodiment;
FIG. 9a is a block diagram showing the structure of an automatic walking apparatus in one embodiment;
fig. 9b is a block diagram showing the structure of the automatic walking apparatus in one embodiment.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
In one embodiment, the automatic walking device is mounted with a photosensor including a light emitting unit and a light receiving unit. Referring to fig. 1, an embodiment of the present application provides an obstacle avoidance method for an automatic walking device, including the following steps:
and S110, transmitting a light signal to the obstacle through the light transmitting unit.
And S120, receiving the reflected light signal reflected by the obstacle through the light receiving unit.
Among them, the photo sensor is a device that converts an optical signal into an electrical signal. The working principle is based on the photoelectric effect. The photoelectric effect refers to the phenomenon that when light irradiates on some substances, electrons of the substances absorb the energy of photons, and the corresponding electric effect occurs. The automatic walking equipment can be intelligent equipment with an automatic walking function, such as an intelligent mower, an intelligent snow sweeper, an intelligent ground washing vehicle and the like.
Specifically, the automatic walking device is mounted with a photoelectric sensor including a light emitting unit and a light receiving unit. The light signal is emitted to the surrounding environment through the light emitting unit, and when an obstacle exists in the surrounding environment, the light signal is emitted to the obstacle through the light emitting unit. The obstacle reflects the emitted light signal, and the photoelectric sensor is irradiated by the reflected light signal, that is, the reflected light signal reflected by the obstacle is received by the light receiving unit.
And S130, detecting whether the intensity of the reflected light signal is within a preset threshold range.
The selection of the threshold range is related to the accuracy of identifying the obstacles in the working scene, and the threshold range is too wide to ensure the sensitivity of the automatic walking equipment to the reflected light signals. The too narrow threshold range may cause the response of the automatic walking device to the reflected light signal to be too sensitive, which affects the working efficiency of the automatic walking device, and may affect the user experience, so the setting of the threshold range may be determined according to the actual situation, and the specific value of the threshold range is not limited here.
Specifically, the light receiving unit receives a reflected light signal reflected by the obstacle, compares the intensity of the reflected light signal with a preset threshold range, and detects whether the intensity of the reflected light signal is within the preset threshold range.
S140, if not, adjusting the emitting light power of the light emitting unit.
The intensity of the reflected light signal is related to the intensity of the emitted light signal, the absorption capacity of the obstacle to light, and the like. For example, if the obstacle has a strong light absorption capability, the reflected light intensity is too weak, so that the reflected signal received by the photosensor is too low to be judged as being free of obstacle. At this time, the emission power of the photosensor needs to be increased to increase the intensity of the emitted light signal. For example, if the intensity of the emitted light signal is too weak, the reflected light signal reflected by the surrounding environment is also very small, resulting in erroneous determination as being free of obstacles. For another example, if the intensity of the emitted light signal is too strong, the intensity of the reflected light signal reflected by the surrounding environment is also strong, and the intensity of the reflected light signal is sufficient to determine the obstacle in the surrounding environment, and the intensity of the reflected light signal is used to determine that the obstacle in the surrounding environment is excessive, which results in energy waste.
Specifically, in order to ensure that the emitted light signal intensity of the photoelectric sensor is suitable for identifying obstacles and no energy waste exists, the intensity of the reflected light signal is compared with a preset threshold range, and whether the intensity of the reflected light signal is within the preset threshold range is detected. If the intensity of the reflected light signal is not within the preset threshold range, which indicates that the intensity of the emitted light signal of the photosensor is too large or too small, the emission power of the photosensor, that is, the intensity of the emitted light signal of the photosensor needs to be adjusted.
Further, if the intensity of the reflected light signal is greater than the maximum value of the threshold range, the emitted light power of the photosensor is reduced. If the intensity of the reflected light signal is less than the minimum value of the threshold range, the emitted light power of the photosensor is increased.
In this embodiment, the intensity of the reflected light signal reflected back from the surrounding environment is obtained by the photoelectric sensor, and whether the intensity of the reflected light signal is within a preset threshold range is detected, if not, the intensity of the emitted light signal of the photoelectric sensor is adjusted. The emitting power is adjusted according to the intensity of the reflected light signal, energy waste caused by the emitting power is avoided, and the accuracy of obstacle detection is improved. The transmitting power is adjusted according to the intensity of the reflected light signal, and the phenomenon that the reflected signal is too weak and is judged mistakenly as having no obstacle due to the fact that the transmitting power is too small is avoided.
In one embodiment, referring to fig. 2, before detecting whether the intensity of the reflected light signal is within a preset threshold range, the method further includes:
s210, converting the reflected light signal into a light intensity electric signal and a light energy electric signal, and calculating the intensity of the reflected light signal based on the light intensity electric signal.
Wherein, the optical energy electrical signal refers to an electrical signal representing optical energy. The optical intensity electrical signal refers to an electrical signal indicating the optical intensity. Specifically, the photoelectric sensor emits an optical signal to the surrounding environment, and when an obstacle exists in the surrounding environment, the obstacle reflects the optical signal emitted by the photoelectric sensor. When the photoelectric sensor is irradiated by the reflected light signal, the reflected light signal is converted into a light intensity electric signal and a light energy electric signal through analog-to-digital conversion. Further, the intensity of the reflected light signal may be calculated based on the electrical light intensity signal.
In one embodiment, an obstacle avoidance method for an automatic walking device is provided in the embodiments of the present application, and the method further includes: and calculating the distance between the automatic walking equipment and the barrier based on the light intensity electric signal and the light energy electric signal, and controlling the operation of the automatic walking equipment. The control of the operation of the automatic walking device can be adjusting the walking path and walking speed of the automatic walking device, and can also control the automatic walking device to continue to move forward, move backward, stop moving forward or stop working and the like.
Specifically, referring to fig. 3, the method for calculating the distance between the automatic walking device and the obstacle may include the following steps:
and S310, acquiring a light intensity electric signal of the reflected light.
And S320, calculating a first distance between the obstacle and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal.
And S330, controlling the automatic walking equipment to run according to the first distance.
The photoelectric sensor emits light signals to the surrounding environment, and when obstacles exist in the surrounding environment, the obstacles reflect the light signals emitted by the photoelectric sensor. When the photoelectric sensor is irradiated by the reflected light signal, the photoelectric sensor acquires a light energy electric signal through analog-to-digital conversion. And calculating the ratio of the intensity of the light intensity electric signal to the intensity of the emitted light signal, and calculating the first distance between the obstacle and the automatic walking equipment according to the ratio of the intensity of the light intensity electric signal to the intensity of the emitted light signal. And if the first distance between the obstacle and the automatic walking equipment is smaller, controlling the automatic walking equipment to perform evasion action so as to change the walking path of the automatic walking equipment, and further avoiding the collision between the obstacle and the automatic walking equipment. If the first distance between the obstacle and the automatic walking equipment is large, if the automatic walking equipment can keep the advancing direction to continuously move for a period of time, and in the process of continuously moving, the first distance between the obstacle and the automatic walking equipment is always detected, and when the automatic walking equipment needs to perform evasive action, the walking path of the automatic walking equipment can be changed, so that the obstacle and the automatic walking equipment are prevented from colliding.
Referring to fig. 4, the method for calculating the distance between the automatic walking device and the obstacle may include the steps of:
and S410, calculating a second distance between the obstacle and the automatic walking device according to the phase difference between the emitted light signal and the reflected light signal.
And S420, controlling the automatic walking equipment to run according to the first distance and the second distance.
The photoelectric sensor emits light signals to the surrounding environment, and when obstacles exist in the surrounding environment, the obstacles reflect the light signals emitted by the photoelectric sensor. The photosensor receives the reflected light signal. Wherein, for the photoelectric signal, an amplitude modulated carrier is generally performed on the optical signal, and the second distance between the obstacle and the automatic walking device is calculated by detecting a phase difference of the carrier of the emitted optical signal and the reflected optical signal.
For example, an average value of the distance between the obstacle and the automatic walking device may be obtained according to the first distance and the second distance between the obstacle and the automatic walking device, and the operation of the automatic walking device may be controlled according to the average value of the distance.
For example, the priority of the first distance and the second distance may be set empirically, for example, if the accuracy of the first distance is higher than that of the second distance, when the automatic walking device calculates the first distance and the second distance, the operation of the automatic walking device is controlled according to the first distance. For another example, if the accuracy of the second distance is higher than the accuracy of the first distance, when the automatic walking device calculates the first distance and the second distance, the operation of the automatic walking device is controlled according to the second distance.
In this embodiment, the distance between the obstacle and the automatic traveling device is more accurately calculated according to the first distance and the second distance, so as to determine whether the machine is going forward or takes other actions, and the operation of the automatic traveling device can be more effectively controlled, so as to effectively identify and avoid any obstacle in a certain range around the machine.
Referring to fig. 5, an embodiment of the present application provides an obstacle avoidance method for an automatic walking device, further including the following steps:
and S510, calculating a third distance between the obstacle and the automatic walking device according to the time difference between the emitted light signal and the received reflected light signal.
And S520, controlling the automatic walking equipment to run according to the first distance, the second distance and the third distance.
The photoelectric sensor emits light signals to the surrounding environment, and when obstacles exist in the surrounding environment, the obstacles reflect the light signals emitted by the photoelectric sensor. The photosensor receives the reflected light signal. The timing is started at the same time of the light signal emitting time of the photoelectric sensor, the timing is stopped immediately when the photoelectric sensor receives the reflected light signal reflected back, and the time difference T between the light signal emitting time and the light signal receiving time is recorded. The light signal moves back and forth between the obstacle and the self-propelled apparatus during a time period between the time when the light signal is emitted and the time when the reflected light signal is received. The propagation speed of the optical signal in the air is recorded as V, and the measurement distance S of the cliff recognition probe can be calculated according to the time difference T, namely: and S is V T/2.
For example, an average value of distances between the obstacle and the automatic walking device may be obtained according to the first distance, the second distance, and the third distance between the obstacle and the automatic walking device, and the operation of the automatic walking device may be controlled according to the average value of distances.
For example, the priorities of the first distance, the second distance, and the third distance may be set empirically, for example, if the accuracy of the first distance is higher than the accuracy of the second distance and the third distance, when the automatic walking device calculates the first distance, the second distance, and the third distance, the operation of the automatic walking device is controlled according to the first distance. For example, if the accuracy of the second distance is higher than the accuracy of the first distance and the third distance, when the automatic walking device calculates the first distance, the second distance, and the third distance, the operation of the automatic walking device is controlled according to the second distance. For another example, if the accuracy of the third distance is higher than the accuracy of the first distance and the second distance, when the automatic walking device calculates the first distance, the second distance, and the third distance, the operation of the automatic walking device is controlled according to the third distance.
In this embodiment, the distance between the obstacle and the automatic traveling device is more accurately calculated according to the first distance, the second distance and the third distance, so that whether the machine needs to go forward or take other actions is judged, the operation of the automatic traveling device can be more effectively controlled, and any obstacle in a certain range around the machine can be effectively identified and avoided.
Referring to fig. 6, an embodiment of the present application provides an obstacle avoidance method for an automatic walking device, further including the following steps:
s610, calculating a fourth distance between the obstacle and the automatic walking equipment in a triangular distance measuring mode.
And S620, controlling the walking path of the automatic walking equipment according to the first distance, the second distance, the third distance and the fourth distance.
For example, three photoelectric sensors are used for receiving the reflected light signals in the surrounding environment, the time difference from the reflected light signals to the three photoelectric sensors is calculated to be △ t12, △ t13 and △ t23, and the distances d1, d2 and d3 from the three photoelectric sensors to an obstacle are calculated through the time differences △ t12, △ t13 and △ t 23.
d1-d2=V*△t12;
d1-d3=V*△t13;
d2-d3=V*△t23;
Where V is the speed of the optical signal under the current operating condition. A fourth distance between the obstacle and the self-propelled device may be calculated according to the above formula.
For example, an average distance value between the obstacle and the automatic walking device may be obtained according to the first distance, the second distance, the third distance, and the fourth distance between the obstacle and the automatic walking device, and the operation of the automatic walking device may be controlled according to the average distance value.
For example, the priorities of the first distance, the second distance, the third distance, and the fourth distance may be set empirically, for example, if the accuracy of the first distance is higher than the accuracy of the second distance, the third distance, and the fourth distance, when the automatic walking device calculates the first distance, the second distance, the third distance, and the fourth distance, the operation of the automatic walking device is controlled according to the first distance. For example, if the accuracy of the second distance is higher than the accuracy of the first distance, the third distance, and the fourth distance, when the automatic walking device calculates the first distance, the second distance, the third distance, and the fourth distance, the operation of the automatic walking device is controlled according to the second distance. For example, if the accuracy of the third distance is higher than the accuracy of the first distance, the second distance, and the fourth distance, when the automatic walking device calculates the first distance, the second distance, the third distance, and the fourth distance, the operation of the automatic walking device is controlled according to the third distance. For example, if the accuracy of the fourth distance is higher than the accuracy of the first distance, the second distance, and the third distance, when the automatic walking device calculates the first distance, the second distance, the third distance, and the fourth distance, the operation of the automatic walking device is controlled according to the fourth distance.
In this embodiment, the distance between the obstacle and the automatic traveling device is more accurately calculated according to the first distance, the second distance, the third distance and the fourth distance, so as to determine whether the machine is going forward or takes other actions, and the operation of the automatic traveling device can be more effectively controlled, thereby effectively identifying and avoiding any obstacle in a certain range around the machine.
It should be noted that the automatic traveling device may control the operation of the automatic traveling device according to any one or more of the first distance, the second distance, the third distance, and the fourth distance, where the operation of the automatic traveling device may be to adjust a traveling path and a traveling speed of the automatic traveling device, or to control the automatic traveling device to stop moving forward or stop working, and the like.
In an embodiment, please refer to fig. 7, an embodiment of the present application provides an obstacle avoidance method for an automatic walking device, including the following steps:
and S710, emitting a light signal to the obstacle through the light emitting unit.
And S720, receiving the reflected light signal reflected by the obstacle through the light receiving unit.
And S730, converting the reflected light signal into a light intensity electric signal and a light energy electric signal.
And S740, calculating the intensity of the reflected light signal based on the light intensity electric signal.
And S750, detecting whether the intensity of the reflected light signal is within a preset threshold range.
S761, if the intensity of the reflected light signal is larger than the maximum value of the threshold range, the emitted light power of the photoelectric sensor is reduced.
And S762, if the intensity of the reflected light signal is smaller than the minimum value of the threshold range, increasing the emitted light power of the photoelectric sensor.
And S770, acquiring a light intensity electric signal of the reflected light.
S781, calculating a first distance between the barrier and the automatic walking device according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal.
And S782, calculating a second distance between the obstacle and the automatic walking device according to the phase difference between the emitted light signal and the reflected light signal.
And S783, calculating a third distance between the obstacle and the automatic walking device according to the time difference between the emitted light signal and the received reflected light signal.
S784, calculating a fourth distance between the obstacle and the automatic walking device in a triangular distance measurement mode.
And S790, controlling the walking path of the automatic walking equipment according to the first distance, the second distance, the third distance and the fourth distance.
It should be understood that although the various steps in the flow charts of fig. 1-7 are shown in order as indicated by the arrows, the steps are not necessarily performed in order as indicated by the arrows. The steps are not performed in the exact order shown and described, and may be performed in other orders, unless explicitly stated otherwise. Moreover, at least some of the steps in fig. 1-7 may include multiple sub-steps or multiple stages that are not necessarily performed at the same time, but may be performed at different times, and the order of performance of the sub-steps or stages is not necessarily sequential, but may be performed in turn or alternating with other steps or at least some of the sub-steps or stages of other steps.
In one embodiment, please refer to fig. 8, an embodiment of the present application provides an obstacle avoidance apparatus 800 of an automatic walking device, the apparatus includes:
a transmitting module 810 for transmitting an optical signal to an obstacle through an optical transmitting unit;
a receiving module 820, configured to receive a reflected light signal reflected by an obstacle through a light receiving unit;
a detecting module 830, configured to detect whether the intensity of the reflected light signal is within a preset threshold range;
the adjusting module 840 is configured to adjust the emitted light power of the light emitting unit if the detected signal is not positive.
For specific limitations of the obstacle avoidance device of the automatic walking device, reference may be made to the above limitations of the obstacle avoidance method of the automatic walking device, and details are not described here. All modules in the obstacle avoidance device of the automatic walking equipment can be completely or partially realized through software, hardware and a combination of the software and the hardware. The modules can be embedded in a hardware form or independent from a processor in the computer device, and can also be stored in a memory in the computer device in a software form, so that the processor can call and execute operations corresponding to the modules.
In one embodiment, the present application provides an automatic walking device, please refer to fig. 9a, which includes:
a light emitting unit 910 for emitting a light signal to an obstacle;
a light receiving unit 920 for receiving a reflected light signal reflected by an obstacle;
the processing unit 930, connected to the light receiving unit, is configured to detect whether the intensity of the reflected light signal is within a preset threshold range, and if not, adjust the emitted light power of the light emitting unit.
In one embodiment, the light receiving unit 910 converts the reflected light signal into an electrical light intensity signal and an electrical light energy signal. The processing unit 930 is also used to calculate the intensity of the reflected light signal based on the electrical light intensity signal.
In one embodiment, the processing unit 930 is further configured to calculate a distance between the autonomous walking apparatus and the obstacle based on the light intensity electrical signal and the light energy electrical signal, and control the operation of the autonomous walking apparatus.
In one embodiment, processing unit 930 is configured to calculate the distance of the automated walking device from the obstacle by one or more of:
calculating a first distance between the barrier and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal;
calculating a second distance between the obstacle and the automatic walking device according to a time difference between the transmitted light signal and the received reflected light signal;
and calculating a third distance between the obstacle and the automatic walking equipment in a triangular distance measurement mode.
In one embodiment, referring to fig. 9b, the automatic walking device further includes a control unit 940 for controlling the operation of the automatic walking device according to one or more of the first distance, the second distance, and the third distance.
In one embodiment, the optical signal emitting unit and the optical receiving unit are integrated on the same photosensor.
In one embodiment, the optical signal transmitting unit includes one photosensor and the optical signal receiving unit includes at least two photosensors.
For specific limitations of the autonomous walking device, reference may be made to the above limitations of the obstacle avoidance method of the autonomous walking device, and details are not described here. The modules of the automatic walking device can be completely or partially realized by software, hardware and a combination thereof. The modules can be embedded in a hardware form or independent from a processor in the computer device, and can also be stored in a memory in the computer device in a software form, so that the processor can call and execute operations corresponding to the modules.
The technical features of the above embodiments can be arbitrarily combined, and for the sake of brevity, all possible combinations of the technical features in the above embodiments are not described, but should be considered as the scope of the present specification as long as there is no contradiction between the combinations of the technical features.
The above-mentioned embodiments only express several embodiments of the present application, and the description thereof is more specific and detailed, but not construed as limiting the scope of the invention. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the concept of the present application, which falls within the scope of protection of the present application. Therefore, the protection scope of the present patent shall be subject to the appended claims.

Claims (13)

1. An obstacle avoidance method for automatic walking equipment, wherein the automatic walking equipment is provided with a photoelectric sensor, the photoelectric sensor comprises a light emitting unit and a light receiving unit, and the obstacle avoidance method is characterized by comprising the following steps:
transmitting a light signal to an obstacle through the light transmitting unit;
receiving a reflected light signal reflected by the obstacle through the light receiving unit;
detecting whether the intensity of the reflected light signal is within a preset threshold range;
if not, the emitted light power of the light emitting unit is adjusted.
2. The method of claim 1, wherein if not, adjusting the emitted optical power of the optical emitting unit comprises:
if the intensity of the reflected light signal is larger than the maximum value of the threshold value range, reducing the emitted light power of the light emitting unit;
and if the intensity of the reflected light signal is smaller than the minimum value of the threshold range, increasing the emitted light power of the light emitting unit.
3. The method of claim 1, wherein before said detecting whether the intensity of the reflected light signal is within a preset threshold range, the method further comprises:
and converting the reflected light signal into a light intensity electric signal and a light energy electric signal, and calculating the intensity of the reflected light signal based on the light intensity electric signal.
4. The method of claim 3, further comprising:
and calculating the distance between the automatic walking equipment and the barrier based on the light intensity electric signal and the light energy electric signal, and controlling the operation of the automatic walking equipment.
5. The method according to claim 4, wherein the method for calculating the distance between the automatic walking device and the obstacle comprises one or more of the following methods:
calculating a first distance between the barrier and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal;
calculating a second distance between the obstacle and the automatic walking device according to a time difference between the transmitted light signal and the received reflected light signal;
and calculating a third distance between the obstacle and the automatic walking equipment in a triangular distance measurement mode.
6. The utility model provides an automatic walking equipment keeps away barrier device, automatic walking equipment installs light emission unit and light receiving unit, its characterized in that, the device includes:
a transmitting module for transmitting an optical signal to an obstacle through the optical transmitting unit;
the receiving module is used for receiving a reflected light signal reflected by the obstacle through the light receiving unit;
the detection module is used for detecting whether the intensity of the reflected light signal is within a preset threshold range;
and the adjusting module is used for adjusting the transmitting light power of the light transmitting unit if the light transmitting unit does not transmit light.
7. An automated walking device, comprising:
a light emitting unit for emitting a light signal to an obstacle;
a light receiving unit for receiving a reflected light signal reflected by the obstacle;
and the processing unit is connected with the light receiving unit and used for detecting whether the intensity of the reflected light signal is within a preset threshold range or not, and if not, the transmitting light power of the light transmitting unit is adjusted.
8. The automatic walking device of claim 7, wherein said light receiving unit converts said reflected light signal into an electrical light intensity signal and an electrical light energy signal;
the processing unit is further used for calculating the intensity of the reflected light signal based on the light intensity electric signal.
9. The automatic walking device of claim 8, wherein the processing unit is further configured to calculate a distance between the automatic walking device and an obstacle based on the light intensity electrical signal and the light energy electrical signal, and control the operation of the automatic walking device.
10. The automated walking device of claim 9, wherein the processing unit is configured to calculate the distance of the automated walking device from the obstacle by one or more of:
calculating a first distance between the barrier and the automatic walking equipment according to the light intensity electric signal of the reflected light and the intensity of the emitted light signal;
calculating a second distance between the obstacle and the automatic walking device according to a time difference between the transmitted light signal and the received reflected light signal;
and calculating a third distance between the obstacle and the automatic walking equipment in a triangular distance measurement mode.
11. The automated walking device of claim 10, further comprising a control unit for controlling the operation of the automated walking device according to one or more of the first distance, the second distance, and the third distance.
12. The automatic walking device of claim 7, wherein said light signal emitting unit and light receiving unit are integrated on the same photosensor.
13. The automatic walking device of claim 7, wherein said light signal emitting unit comprises one photoelectric sensor and said light signal receiving unit comprises at least two photoelectric sensors.
CN201811456314.7A 2018-11-30 2018-11-30 Automatic walking equipment and obstacle avoidance method and device thereof Active CN111338332B (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201811456314.7A CN111338332B (en) 2018-11-30 2018-11-30 Automatic walking equipment and obstacle avoidance method and device thereof
PCT/CN2019/116259 WO2020108267A1 (en) 2018-11-30 2019-11-07 Autonomous traveling device and obstacle avoidance method and apparatus thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811456314.7A CN111338332B (en) 2018-11-30 2018-11-30 Automatic walking equipment and obstacle avoidance method and device thereof

Publications (2)

Publication Number Publication Date
CN111338332A true CN111338332A (en) 2020-06-26
CN111338332B CN111338332B (en) 2022-03-18

Family

ID=70851904

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811456314.7A Active CN111338332B (en) 2018-11-30 2018-11-30 Automatic walking equipment and obstacle avoidance method and device thereof

Country Status (2)

Country Link
CN (1) CN111338332B (en)
WO (1) WO2020108267A1 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112596111A (en) * 2020-11-04 2021-04-02 普联技术有限公司 Obstacle identification method, device and equipment and readable storage medium
CN112731412A (en) * 2020-12-28 2021-04-30 南京苏美达智能技术有限公司 Ultrasonic obstacle avoidance method and automatic walking equipment
CN113331744A (en) * 2021-06-16 2021-09-03 深圳市银星智能科技股份有限公司 Traveling control method of cleaning robot, obstacle avoidance module and cleaning robot
CN113655470A (en) * 2021-08-09 2021-11-16 珠海格力电器股份有限公司 Object detection method, device, equipment and storage medium

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113495567A (en) * 2021-08-27 2021-10-12 湖南格兰博智能科技有限责任公司 Cliff detection method and sweeping robot

Citations (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2355523A (en) * 1999-10-21 2001-04-25 Notetry Ltd Infrared detection system
US20040088079A1 (en) * 2001-01-26 2004-05-06 Erwan Lavarec Method and device for obstacle detection and distance measurement by infrared radiation
US20040105087A1 (en) * 2002-08-09 2004-06-03 Torsten Gogolla Laser distance measuring device with phase delay measurement
EP1772749A1 (en) * 2005-09-30 2007-04-11 Kabushiki Kaisha Topcon Distance measuring device
IE20060275A1 (en) * 2006-04-10 2007-11-14 Trinity College Dublin A method and aparatus for determining distance between two spaced apart surfaces
US20080231831A1 (en) * 2007-03-23 2008-09-25 Fujifilm Corporation Ranging apparatus and ranging method
US20100157281A1 (en) * 2008-12-22 2010-06-24 Asia Optical Co., Inc. Laser distance measuring apparatus and control method thereof
US20110216326A1 (en) * 2010-03-03 2011-09-08 Canon Kabushiki Kaisha Lightwave interference measurement apparatus used to measure optical path length or distance
CN102749927A (en) * 2012-07-20 2012-10-24 常州大学 System for pilotless plane to automatically avoid barrier and avoiding method of system
US20140152813A1 (en) * 2011-08-25 2014-06-05 Ifm Electronic Gmbh Time-of-flight camera with signal path monitoring
CN103941306A (en) * 2014-01-13 2014-07-23 苏州爱普电器有限公司 Cleaning robot and method for controlling same to avoid obstacle
EP2821748A1 (en) * 2012-03-01 2015-01-07 Nissan Motor Co., Ltd. Range finding device and range finding method
CN104730532A (en) * 2013-12-18 2015-06-24 Lg电子株式会社 Distance measuring device and method thereof
CN205809293U (en) * 2015-09-06 2016-12-14 北醒(北京)光子科技有限公司 Unmanned plane, unmanned vehicle and walking robot infrared distance measurement and fault avoidnig device
CN106597404A (en) * 2016-11-29 2017-04-26 上海无线电设备研究所 Terahertz cloud radar signal processing method and system
CN106646189A (en) * 2016-11-14 2017-05-10 无锡爱睿芯电子有限公司 Obstacle detection module
US20170176735A1 (en) * 2015-12-18 2017-06-22 Paris Sciences Et Lettres - Quartier Latin Optical device for measuring the position of an object
US20170328991A1 (en) * 2014-12-02 2017-11-16 Odos Imaging Ltd. Distance measuring device and method for determining a distance
CN107399377A (en) * 2016-05-19 2017-11-28 苏州宝时得电动工具有限公司 from mobile device and its control method
CN108196264A (en) * 2016-12-08 2018-06-22 北京万集科技股份有限公司 A kind of laser distance measurement method, apparatus and system
CN108205140A (en) * 2016-12-16 2018-06-26 意法半导体股份有限公司 The method and related device of detection object
CN108267752A (en) * 2016-12-15 2018-07-10 苏州宝时得电动工具有限公司 Partition method, device and electronic equipment from the working region of mobile equipment
WO2018150998A1 (en) * 2017-02-17 2018-08-23 北陽電機株式会社 Object capturing device, capture target, and object capturing system
CN108519601A (en) * 2018-04-13 2018-09-11 深圳臻迪信息技术有限公司 Distance measuring method, device and distance mearuring equipment
CN108664014A (en) * 2017-03-29 2018-10-16 苏州宝时得电动工具有限公司 A kind of automatic running device returns the control method and device of charging

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101435869B (en) * 2008-10-22 2012-07-04 上海科勒电子科技有限公司 Power consumption saving method of distance detection induction device
WO2011150891A2 (en) * 2011-06-24 2011-12-08 华为终端有限公司 Method and device through which a terminal determines approach of an object
US9354318B1 (en) * 2015-03-05 2016-05-31 Horizon Hobby, LLC Optical spread spectrum detection and ranging
CN104811546B (en) * 2015-04-02 2019-05-14 深圳市金立通信设备有限公司 A kind of terminal
CN205679994U (en) * 2015-08-16 2016-11-09 北醒(北京)光子科技有限公司 A kind of intelligent distance-measuring and the circuit of obstacle avoidance apparatus
CN107045352A (en) * 2017-05-31 2017-08-15 珠海市微半导体有限公司 Based on how infrared robot obstacle-avoiding device, its control method and Robot side control method

Patent Citations (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2355523A (en) * 1999-10-21 2001-04-25 Notetry Ltd Infrared detection system
US20040088079A1 (en) * 2001-01-26 2004-05-06 Erwan Lavarec Method and device for obstacle detection and distance measurement by infrared radiation
US20040105087A1 (en) * 2002-08-09 2004-06-03 Torsten Gogolla Laser distance measuring device with phase delay measurement
EP1772749A1 (en) * 2005-09-30 2007-04-11 Kabushiki Kaisha Topcon Distance measuring device
IE20060275A1 (en) * 2006-04-10 2007-11-14 Trinity College Dublin A method and aparatus for determining distance between two spaced apart surfaces
US20080231831A1 (en) * 2007-03-23 2008-09-25 Fujifilm Corporation Ranging apparatus and ranging method
US20100157281A1 (en) * 2008-12-22 2010-06-24 Asia Optical Co., Inc. Laser distance measuring apparatus and control method thereof
US20110216326A1 (en) * 2010-03-03 2011-09-08 Canon Kabushiki Kaisha Lightwave interference measurement apparatus used to measure optical path length or distance
US20140152813A1 (en) * 2011-08-25 2014-06-05 Ifm Electronic Gmbh Time-of-flight camera with signal path monitoring
EP2821748A1 (en) * 2012-03-01 2015-01-07 Nissan Motor Co., Ltd. Range finding device and range finding method
CN102749927A (en) * 2012-07-20 2012-10-24 常州大学 System for pilotless plane to automatically avoid barrier and avoiding method of system
CN104730532A (en) * 2013-12-18 2015-06-24 Lg电子株式会社 Distance measuring device and method thereof
CN103941306A (en) * 2014-01-13 2014-07-23 苏州爱普电器有限公司 Cleaning robot and method for controlling same to avoid obstacle
US20170328991A1 (en) * 2014-12-02 2017-11-16 Odos Imaging Ltd. Distance measuring device and method for determining a distance
CN205809293U (en) * 2015-09-06 2016-12-14 北醒(北京)光子科技有限公司 Unmanned plane, unmanned vehicle and walking robot infrared distance measurement and fault avoidnig device
US20170176735A1 (en) * 2015-12-18 2017-06-22 Paris Sciences Et Lettres - Quartier Latin Optical device for measuring the position of an object
CN107399377A (en) * 2016-05-19 2017-11-28 苏州宝时得电动工具有限公司 from mobile device and its control method
CN106646189A (en) * 2016-11-14 2017-05-10 无锡爱睿芯电子有限公司 Obstacle detection module
CN106597404A (en) * 2016-11-29 2017-04-26 上海无线电设备研究所 Terahertz cloud radar signal processing method and system
CN108196264A (en) * 2016-12-08 2018-06-22 北京万集科技股份有限公司 A kind of laser distance measurement method, apparatus and system
CN108267752A (en) * 2016-12-15 2018-07-10 苏州宝时得电动工具有限公司 Partition method, device and electronic equipment from the working region of mobile equipment
CN108205140A (en) * 2016-12-16 2018-06-26 意法半导体股份有限公司 The method and related device of detection object
WO2018150998A1 (en) * 2017-02-17 2018-08-23 北陽電機株式会社 Object capturing device, capture target, and object capturing system
CN108664014A (en) * 2017-03-29 2018-10-16 苏州宝时得电动工具有限公司 A kind of automatic running device returns the control method and device of charging
CN108519601A (en) * 2018-04-13 2018-09-11 深圳臻迪信息技术有限公司 Distance measuring method, device and distance mearuring equipment

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张宁: "基于激光测距建模的空间设计合理性分析", 《激光杂志》 *
陶香琴: "光电测距仪的室内检定", 《计量技术》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112596111A (en) * 2020-11-04 2021-04-02 普联技术有限公司 Obstacle identification method, device and equipment and readable storage medium
CN112596111B (en) * 2020-11-04 2024-02-13 普联技术有限公司 Obstacle recognition method, device, equipment and readable storage medium
CN112731412A (en) * 2020-12-28 2021-04-30 南京苏美达智能技术有限公司 Ultrasonic obstacle avoidance method and automatic walking equipment
CN112731412B (en) * 2020-12-28 2023-09-15 南京苏美达智能技术有限公司 Ultrasonic obstacle avoidance method and automatic walking equipment
CN113331744A (en) * 2021-06-16 2021-09-03 深圳市银星智能科技股份有限公司 Traveling control method of cleaning robot, obstacle avoidance module and cleaning robot
CN113655470A (en) * 2021-08-09 2021-11-16 珠海格力电器股份有限公司 Object detection method, device, equipment and storage medium
CN113655470B (en) * 2021-08-09 2023-10-10 珠海格力电器股份有限公司 Object detection method, device, equipment and storage medium

Also Published As

Publication number Publication date
WO2020108267A1 (en) 2020-06-04
CN111338332B (en) 2022-03-18

Similar Documents

Publication Publication Date Title
CN111338332B (en) Automatic walking equipment and obstacle avoidance method and device thereof
CN111796290B (en) Ground detection method, ground detector and autonomous mobile device
US11614744B2 (en) Self-moving apparatus and method for controlling same
US20190204847A1 (en) Moving apparatus for cleaning and method of controlling the same
CN109426264A (en) From mobile device and its control method of movement routine
CN108209773A (en) The intelligent barrier avoiding method of clean robot and clean robot
US11998159B2 (en) Vacuum cleaner and control method thereof
JP2011245295A (en) Direction device and operation system utilizing the same
US11666194B2 (en) Ultrasonic sensor and robot cleaner equipped therewith
AU2019399322B2 (en) Robot cleaner and method for operating same
US12059115B2 (en) Cleaner and method for controlling same
CN111381289A (en) Infrared lamp self-adaptive environment obstacle detection method and mobile device
JP2019002890A (en) Ranging system and control method thereof
CN109426266A (en) From mobile device
CN112764033A (en) Distance detection method and device and mobile robot
CN112386177A (en) Cleaning device motion control method, storage medium and cleaning device
KR100662638B1 (en) Apparatus for correcting obstacle detection error of robot cleaner and method therefor
CN113119128A (en) Robot, operation control method thereof, electronic device, and storage medium
KR102226360B1 (en) Distance Measuring Sensor Detecting Jam State or Masked State by Foreign Object, and Mobile Robot
CN114305260B (en) Control method and device of cleaning robot, medium and cleaning robot
CN116381711A (en) Anti-interference distance measurement method and depth camera
CN108431715A (en) Automatic identification objects in front from mobile device and its recognition methods
US20230225580A1 (en) Robot cleaner and robot cleaner control method
CN207937608U (en) Detection components, sweeping robot and the system for detecting its road conditions of walking
CN113741441A (en) Operation method and self-moving equipment

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant