[go: up one dir, main page]

WO2019007037A1 - Mobile robot, working surface recognition method and control method - Google Patents

Mobile robot, working surface recognition method and control method Download PDF

Info

Publication number
WO2019007037A1
WO2019007037A1 PCT/CN2018/073805 CN2018073805W WO2019007037A1 WO 2019007037 A1 WO2019007037 A1 WO 2019007037A1 CN 2018073805 W CN2018073805 W CN 2018073805W WO 2019007037 A1 WO2019007037 A1 WO 2019007037A1
Authority
WO
WIPO (PCT)
Prior art keywords
speed
current
mobile robot
duty ratio
ratio
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.)
Ceased
Application number
PCT/CN2018/073805
Other languages
French (fr)
Chinese (zh)
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.)
Guangdong Bona Robot Corp Ltd
Original Assignee
Guangdong Bona Robot Corp 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 Guangdong Bona Robot Corp Ltd filed Critical Guangdong Bona Robot Corp Ltd
Publication of WO2019007037A1 publication Critical patent/WO2019007037A1/en
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L9/00Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
    • A47L9/28Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • 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 invention belongs to the field of mobile robots, in particular to a working surface recognition method for a mobile robot and a mobile robot, and a control method based on a working surface.
  • Existing covered mobile robots (such as sweeping robots and mowing robots) often have a single working mode, and the same working mode is adopted when working on different working surfaces, which results in low working efficiency and poor working effect of the mobile robot.
  • the prior art mostly realizes the recognition of the working surface by the mobile robot by detecting the working current of the motor.
  • the patent document of Chinese Patent Application No. 200510050557.7 discloses a scheme for judging the type of the ground by detecting the operating current of the rotating electrical machine.
  • the detection error may occur. There is a misjudgment.
  • the patent document No. 201310757423.3 discloses a scheme for identifying the type of work surface based on image analysis, but the scheme involves image processing and matching algorithms, and the scheme is complicated and the implementation cost is high.
  • One of the objects of the present invention is to overcome the deficiencies in the background art and provide a working surface recognition method for a mobile robot.
  • the specific solution is as follows:
  • a working surface recognition method for a mobile robot comprising:
  • a current working surface type of the mobile robot is determined based on a ratio of the current duty ratio to the current speed.
  • step of acquiring the current speed of the mobile robot in real time further includes:
  • a mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset.
  • the step of acquiring the current speed of the mobile robot and the current duty ratio further includes:
  • the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed.
  • the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further includes:
  • the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed.
  • step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be:
  • the average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed.
  • the step of determining the current working surface type of the mobile robot based on the ratio of the current duty ratio to the current speed comprises:
  • the current working surface type is obtained based on the ratio of the current duty ratio to the current speed and the ratio of duty ratio to speed and the type of work surface.
  • the mobile robot is a sweeping robot, and the sweeping robot includes a driving wheel or a rotating brush.
  • the mobile robot is a mowing robot
  • the mowing robot includes a driving wheel or a rotating cutter.
  • the invention also provides a control method of a mobile robot based on a work surface, the scheme of which is as follows:
  • a control method of the mobile robot comprises:
  • the mobile robot is controlled to enter the corresponding working mode according to the type of the working surface.
  • step of acquiring the current speed of the mobile robot in real time further includes:
  • a mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset.
  • the step of acquiring the current speed of the mobile robot and the current duty ratio further includes:
  • the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed.
  • the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further includes:
  • the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed.
  • step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be:
  • the average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed.
  • a second object of the present invention is to overcome the deficiencies in the background art, and to provide a mobile robot capable of accurately identifying a type of work surface and having a low implementation cost, and the scheme is as follows:
  • a mobile robot includes a rotating device, including an acquiring module, a storage module, a judging module and a driving module;
  • the acquiring module is configured to acquire a current speed of the rotating device of the mobile robot and a current duty ratio
  • the storage module is configured to store a mapping table of mobile robot program instructions, a ratio of duty ratio to speed, and a type of work surface;
  • the determining module is configured to calculate a ratio of a current duty ratio to a current speed according to a current speed of the rotating device acquired by the acquiring module and a current duty ratio; and based on a ratio of the current duty ratio to the current speed and the storage in the storage module Determining the ratio of duty cycle to speed of the rotating device and the mapping table of the working surface type to determine the current working surface type of the mobile robot;
  • the driving module is configured to drive the rotating device to operate according to an instruction issued by the determining module.
  • the acquisition module includes a Hall sensor or a photoelectric speed sensor for acquiring the speed of the rotating device and a single chip microcomputer for acquiring the duty ratio of the rotating device;
  • the storage module is a memory of the single chip microcomputer
  • the determining module is a single chip microcomputer
  • the drive module is a drive IC.
  • the mobile robot is a mowing robot
  • the rotating device is a driving wheel or a rotating cutter.
  • the mobile robot is a sweeping robot
  • the rotating device is a driving wheel or a rotating brush.
  • the solution of the invention is based on the fact that the ratio of the duty ratio to the speed of the rotating device is different when the rotating device is operating on different surfaces during normal operation, and the working surface is determined by detecting the ratio of the duty ratio of the rotating device of the mobile robot to the speed in real time.
  • the type has the advantages of high recognition accuracy and low implementation cost.
  • FIG. 1 is a flowchart of a working surface recognition method of a mobile robot according to an embodiment of the present invention
  • FIG. 2 is a flowchart of a method for controlling a mobile robot to reach a preset speed according to an embodiment of the present invention
  • FIG. 3 is a flowchart of a method for calculating a ratio of a current duty ratio to a current speed according to an embodiment of the present invention
  • FIG. 4 is a schematic structural diagram of a module of a mobile robot according to an embodiment of the present invention.
  • Reference numerals: 100 is a rotating device, 200 is an acquisition module, 300 is a storage module, 400 is a determination module, and 500 is a drive module.
  • the mobile robot in this embodiment will be described by taking a sweeping robot as an example.
  • FIG. 1 is a flowchart of a method for identifying a working surface of a mobile robot according to an embodiment of the present invention.
  • a working surface recognition method of a mobile robot may include the following steps S100 to S400.
  • Step S100 Acquire the current speed of the mobile robot in real time.
  • the duty cycle output of the driving wheel of the cleaning robot is controlled by the PID program, and the speed given value V(t) when the cleaning robot is normally operated is set, which is 22 cm/s in this embodiment. That is, no matter what kind of ground, the sweeping robot adjusts the duty ratio through the PID control program, so that the sweeping robot uses V(t) as the speed at normal working.
  • a mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset.
  • the Hall sensor periodically detects the magnet and transmits it by mounting a magnet (such as a magnet) on the left and right driving wheels (rotating device 100) of the cleaning robot and installing a Hall sensor near the driving wheel so that the left and right driving wheels rotate.
  • the signal is sent to the single chip microcomputer, and the single chip computer calculates the current speed V of the driving wheel according to the obtained signal (the angular speed * the driving wheel radius can obtain the driving wheel speed).
  • Step S200 Acquire a current speed of the mobile robot and a current duty ratio when the current speed is greater than the preset speed.
  • the current speed V is greater than the preset speed V0, and V0 is slightly smaller than the normal working speed V(t).
  • V0 is slightly smaller than the normal working speed V(t).
  • the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed. That is, if the current speed V is not greater than V0, the cleaning robot is considered to be in an abnormal working state, and the speed is detected again at intervals (for example, 1 second).
  • Step S300 Calculate a ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio.
  • the speed of the left and right driving wheels of the cleaning robot is detected to be greater than V0
  • the speed V of the driving wheel at the same time and the duty ratio P of the driving wheel are acquired, and then sent to the single-chip microcomputer; the single-chip microcomputer according to the speed V of the driving wheel and the driving wheel
  • the duty cycle P calculates the ratio of the duty cycle P of the drive wheel to the speed V of the drive wheel.
  • Step S400 Determine the current working surface type of the mobile robot based on the ratio of the current duty ratio to the current speed.
  • the single-chip microcomputer compares the ratio K between the duty ratio P and the speed V obtained at the same time, and then compares K with the ratio of the duty ratio to the speed stored in the memory of the single-chip microcomputer and the mapping table of the working surface type, and further Determine the type of surface where the sweeping robot is currently located.
  • FIG. 2 is a flowchart of a method for controlling a mobile robot to reach a preset speed according to an embodiment of the present invention.
  • the method of controlling the mobile robot to reach the preset speed may include the following steps S210 to S240.
  • Step S210 When the current speed is not greater than the preset speed, calculate a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed.
  • the current speed is not greater than the preset speed V0, the speed difference between the normal working speed V(t) and the current speed is calculated.
  • Step S220 Calculate a value of a duty ratio that needs to be increased to reach a normal working speed based on the speed difference.
  • the PID control program calculates the value of the duty cycle that needs to be increased based on the speed difference.
  • Step S230 Adjust the current speed of the mobile robot based on the value of the duty ratio that needs to be increased.
  • the value of the duty ratio that needs to be increased is output to the driving IC to move the driving wheel, and the current speed of the mobile robot is adjusted.
  • Step S240 After the preset time, the current speed of the mobile robot is acquired again and it is determined whether it is greater than the preset speed.
  • the Hall sensor transmits the actual speed of the current driving wheel (at this time, greater than 0, but still a small value) to the MCU, and then the PID control program according to V(t) and the current speed.
  • the difference is calculated by the duty ratio to be increased, and then output to the drive IC to move the drive wheel, and so on, until the speed of the drive wheel is detected to be greater than the preset value V0 (V0 is set to 18 cm/s in this embodiment).
  • the main purpose of the method is to confirm that the sweeping robot is in a normal continuous working state and avoid subsequent misjudgment.
  • the sweeping robot mobile robot
  • the speed of the rotating device 100 drive wheel or rotating brush
  • PID control The duty cycle output of the program is higher than the duty cycle or even full load during normal operation.
  • the ratio of duty cycle to speed at this time has no reference value.
  • FIG. 3 is a flowchart of a method for calculating a ratio of a current duty ratio to a current speed according to an embodiment of the present invention.
  • the method of calculating the ratio of the current duty ratio to the current speed may include the following steps S310 to S340.
  • Step S310 Acquire the current speed of the mobile robot and the current duty ratio multiple times within a preset time.
  • the speed Vi of the driving wheel and the duty ratio Pi can be obtained multiple times in a period of time, such as acquiring 50 times in 1 second.
  • Step S320 Calculate a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio.
  • the speed Vi of the driving wheel and the ratio of the current duty ratio of the corresponding duty cycle Pi to the corresponding current speed are calculated according to the speed Vi and the duty ratio Pi of the driving wheel being acquired multiple times.
  • Step S330 Calculate an average value of the ratio of the current duty ratio to the corresponding current speed based on the ratio of the current duty ratio to the corresponding current speed.
  • an average value of the duty ratio Pi of the driving wheel and the speed Vi ratio Ki in the period of time is calculated according to a ratio of the plurality of current duty ratios to the corresponding current speed.
  • Step S340 The average value of the ratio of the current duty ratio to the current speed is used as a ratio of the current duty ratio to the current speed.
  • the average value of the ratio of the current duty ratio to the current speed is used as the ratio of the current duty ratio to the current speed, which can effectively prevent the sweeping robot from crossing the threshold and other short-time state changes during the movement to the ground. Misjudgment of type. It should be noted that the speed V and the duty ratio P here are digital signals, and the accuracy is better than the analog signal obtained by detecting the current.
  • the mobile robot is a sweeping robot
  • the sweeping robot includes a driving wheel or a rotating brush.
  • the mobile robot is a mowing robot
  • the mowing robot comprises a driving wheel or a rotating cutter.
  • Ratio K the average value of K or Ki is compared with the preset ratio of duty ratio to speed stored in the memory of the single chip microcomputer and the mapping table of the working surface type, thereby determining the type of the surface of the sweeping robot at the current time.
  • the sweeping robot works on ordinary floor, the driving wheel is less resisted, and the duty ratio when controlling the sweeping robot to advance at 22cm/s is about 25%, that is, the duty ratio required for the average 1cm/s speed is 1.126%;
  • the driving wheel is subjected to a large resistance, and the duty ratio for controlling the sweeping robot to advance at a speed of 22 cm/s is about 52%, that is, the duty ratio required for an average speed of 1 cm/s is 2.36%;
  • the duty ratio for controlling the sweeping robot to advance at a speed of 22 cm/s is about 75%, that is, the duty ratio required for an average speed of 1 cm/s is 3.41%.
  • the ratio K by comparing the ratio K with the corresponding floor surface type, when the ratio K is less than 1.8, it is determined that the working surface of the sweeping robot is the floor at the current time or the current time period; when the ratio K is between 1.8 and 2.8, it is judged that The working surface of the sweeping robot is a normal carpet at the current time or the current time period; when the ratio K is above 2.8, it is judged that the working surface of the sweeping robot is a long-haired carpet at the current time or the current time period.
  • the embodiment further provides a control method of the mobile robot.
  • the working surface recognition method of the mobile robot the working surface type of the mobile robot is obtained, and then the mobile robot is controlled to enter the corresponding working mode according to the working surface type.
  • the memory of the single-chip microcomputer stores the working mode of the cleaning robot on different grounds, and is associated with the threshold K ratio of the duty ratio P and the speed V, and the sweeping robot according to a certain time ratio K or a certain period of time
  • the average value of the ratio Ki enters the corresponding working mode.
  • the differences between the modes include: different suction forces of the vacuum fan, different rotational speeds of the rotating brushes, and different cleaning methods. Thereby, the corresponding ground is cleanly cleaned to achieve better cleaning effect and improve cleaning efficiency.
  • the ground type of the working of the sweeping robot can also be recognized by detecting the speed and the duty ratio of the rotating brush of the cleaning robot. At this time, the rotating brush needs to continuously contact the ground to detect the resistance of different grounds.
  • FIG. 4 is a schematic structural diagram of a module of a mobile robot according to an embodiment of the present invention.
  • the cleaning robot in this embodiment includes a rotation device 100 , an acquisition module 200 , a storage module 300 , a determination module 400 , and a drive module 500 .
  • the acquiring module 200 is configured to acquire a current speed of the rotating device 100 of the mobile robot and a current duty ratio
  • the storage module 300 is configured to store a mobile robot program command, a ratio of duty ratio to speed, and a working surface type.
  • the determining module 400 is configured to calculate a ratio of the current duty ratio to the current speed according to the current speed of the rotating device 100 acquired by the acquiring module 200 and the current duty ratio; and based on the current duty ratio and the current speed.
  • the ratio and the ratio of the ratio of the duty ratio of the rotating device 100 stored in the storage module 300 to the working surface type are determined, and the current working surface type of the mobile robot is determined; the driving module 500 is configured to be driven according to an instruction issued by the determining module 400.
  • the rotating device 100 operates.
  • the rotating device 100 is a left and right driving wheel;
  • the obtaining module 200 includes a Hall sensor for acquiring the driving wheel speed and a single chip for obtaining the driving wheel duty ratio;
  • the storage module 300 is a memory of the single chip microcomputer of the cleaning robot;
  • the determining module 400 is a single chip microcomputer;
  • Module 500 is a driver IC.
  • the single-chip microcomputer in this embodiment is implanted with a PID program to control the rotational speed of the driving wheel;
  • the memory of the single-chip microcomputer ie, the storage module 300
  • the ROM is used to store the mobile robot program instructions, the duty ratio and speed of the rotating device 100.
  • the threshold range of the ratio and the corresponding work surface type; RAM is used to store the duty cycle of the PID program real-time calculation.
  • the microcontroller PID control program can directly read and modify the duty cycle of the drive wheel stored in the RAM, and then the microcontroller outputs the duty cycle information to the drive IC, and the drive wheel is rotated by the drive IC; the Hall sensor detects the drive wheel speed and transmits To the microcontroller, compare the drive wheel speed set by the PID program, and then increase or decrease the duty cycle according to the comparison result to control the drive wheel speed.
  • the rotating device 100 in this embodiment may also be a rotating brush of the cleaning robot; the acquiring module 200 for acquiring the driving wheel speed may also adopt a photoelectric speed measuring sensor. Since the Hall sensor and the photoelectric velocity sensor are prior art to those skilled in the art, the implementation process will not be described.
  • the principle that the sweeping robot recognizes the ground type is: when the driving speed of the sweeping robot is greater than a certain value and the uniform speed is moved, the duty ratio P of the driving wheel changes within a small range, and therefore, the driving wheel is occupied.
  • the ratio of the ratio P to the speed V(t) of the drive wheel also varies within a small range.
  • the driving wheel duty cycle P will increase.
  • the driving wheel speed V When the driving wheel speed V reaches the set value V(t), the driving wheel speed V remains unchanged, the driving wheel duty ratio increases, and the ratio K of the driving wheel duty ratio P to the driving wheel speed V increases; The surface resistance suddenly decreases, the driving wheel load suddenly decreases, and the driving wheel speed is not updated in time. The driving wheel speed will increase. In order to keep the driving wheel speed at the set value, the driving wheel duty cycle P will decrease.
  • the driving wheel speed V reaches the set value V(t)
  • the driving wheel speed V remains unchanged, the driving wheel duty ratio decreases, and the ratio K of the driving wheel duty ratio P to the driving wheel speed V decreases. Therefore, the ratio of the duty cycle to the speed of the driving wheel can represent the resistance of the current ground of the driving wheel, and the ground type can be judged according to the magnitude of the ground resistance.
  • the mobile robot in this embodiment will be described by taking a mowing robot as an example.
  • the mowing robot in this embodiment includes a rotation device 100, an acquisition module 200, a storage module 300, a determination module 400, and a drive module 500.
  • the rotating device 100 in this embodiment is a driving wheel or a rotating cutter head;
  • the acquisition module 200 of the embodiment includes a Hall sensor for acquiring the rotational speed of the driving wheel or the rotating cutter head;
  • the storage module 300 is a single-chip microcomputer for the mowing robot.
  • the memory of the determination module 400 is a single chip microcomputer.
  • the lawn type identification method of the mowing robot in this embodiment is basically the same as the ground type identified in the embodiment 1. The difference is that the mowing robot can be detected by detecting the rotation speed and duty ratio of the rotary cutter head of the mowing robot. The condition of the lawn, then enter the corresponding mowing mode to improve the mowing effect and efficiency.
  • the principle of working lawn condition recognition based on mowing robot is: the higher the height of the lawn, the greater the resistance of the driving wheel and the rotating cutter head, and the driving wheel or rotation while maintaining the driving wheel speed or the rotating cutter wheel speed at the set value.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Artificial Intelligence (AREA)
  • Software Systems (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

一种移动机器人的工作表面识别方法,包括:(S100)实时获取移动机器人的当前速度;(S200)当当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比;(S300)基于当前速度以及当前占空比,计算当前占空比与当前速度的比值;(S400)基于当前占空比与当前速度的比值,判断移动机器人当前工作表面类型。此外,还揭示了一种移动机器人的控制方法以及移动机器人。A working surface recognition method for a mobile robot, comprising: (S100) acquiring a current speed of the mobile robot in real time; (S200) acquiring a current speed of the mobile robot and a current duty ratio when the current speed is greater than the preset speed; (S300) Calculating a ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio; (S400) determining a current working surface type of the mobile robot based on a ratio of the current duty ratio to the current speed. In addition, a control method of a mobile robot and a mobile robot are also disclosed.

Description

移动机器人、工作表面识别方法及控制方法Mobile robot, working surface recognition method and control method 技术领域Technical field

本发明属于移动机器人领域,尤其是涉及移动机器人、移动机器人的工作表面识别方法及基于工作表面的控制方法。The invention belongs to the field of mobile robots, in particular to a working surface recognition method for a mobile robot and a mobile robot, and a control method based on a working surface.

背景技术Background technique

现有的覆盖式移动机器人(如扫地机器人、割草机器人)在往往只有单一的工作模式,在不同的工作表面作业时都采取同一工作模式,进而导致移动机器人的工作效率低、工作效果差。Existing covered mobile robots (such as sweeping robots and mowing robots) often have a single working mode, and the same working mode is adopted when working on different working surfaces, which results in low working efficiency and poor working effect of the mobile robot.

针对上述问题,现有技术大多通过检测电机工作电流来实现移动机器人对工作表面的识别。例如,中国专利申请号为200510050557.7的专利文献中揭示了一种通过检测旋转电机的工作电流来判断地面类型的方案,但由于单片机ADC精度不高以及外部电路损耗等原因都会导致检测出现误差,进而存在误判情况。In view of the above problems, the prior art mostly realizes the recognition of the working surface by the mobile robot by detecting the working current of the motor. For example, the patent document of Chinese Patent Application No. 200510050557.7 discloses a scheme for judging the type of the ground by detecting the operating current of the rotating electrical machine. However, due to the low precision of the single-chip ADC and the loss of the external circuit, the detection error may occur. There is a misjudgment.

针对上述问题,中国专利申请号为201310757423.3的专利文献中揭示了一种基于图像分析来识别工作表面类型的方案,但该方案涉及图像处理及匹配算法,方案较为复杂且实施成本较高。In view of the above problems, the patent document No. 201310757423.3 discloses a scheme for identifying the type of work surface based on image analysis, but the scheme involves image processing and matching algorithms, and the scheme is complicated and the implementation cost is high.

因此有必要设计一种精度高且成本低的用于移动机器人的工作表面识别方案。Therefore, it is necessary to design a work surface recognition scheme for mobile robots with high precision and low cost.

发明内容Summary of the invention

本发明的目的之一在于克服背景技术中的缺陷,提供一种移动机器人的工作表面识别方法,具体方案如下:One of the objects of the present invention is to overcome the deficiencies in the background art and provide a working surface recognition method for a mobile robot. The specific solution is as follows:

一种移动机器人的工作表面识别方法,包括:A working surface recognition method for a mobile robot, comprising:

实时获取移动机器人的当前速度;Get the current speed of the mobile robot in real time;

当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比;Obtaining a current speed of the mobile robot and a current duty ratio when the current speed is greater than a preset speed;

基于所述当前速度以及当前占空比,计算当前占空比与当前速度的比值;Calculating a ratio of a current duty ratio to a current speed based on the current speed and a current duty ratio;

基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型。A current working surface type of the mobile robot is determined based on a ratio of the current duty ratio to the current speed.

进一步地,所述实时获取移动机器人的当前速度的步骤之前还包括:Further, the step of acquiring the current speed of the mobile robot in real time further includes:

预先设置移动机器人的正常工作速度、预设速度以及占空比与速度的比值和工作表面类型的映射表。A mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset.

进一步地,所述当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比的步骤还包括:Further, when the current speed is greater than the preset speed, the step of acquiring the current speed of the mobile robot and the current duty ratio further includes:

当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。When the current speed is not greater than the preset speed, the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed.

进一步地,所述当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度的步骤还包括:Further, when the current speed is not greater than the preset speed, the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further includes:

当所述当前速度不大于预设速度时,基于所述正常工作速度以及当前速度,计算所述正常工作速度与当前速度的速度差;Calculating a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed when the current speed is not greater than the preset speed;

基于所述速度差,计算要达到正常工作速度需要增加的占空比的值;Calculating a value of a duty ratio that needs to be increased to reach a normal operating speed based on the speed difference;

基于所述需要增加的占空比的值,调整移动机器人的当前速度;Adjusting the current speed of the mobile robot based on the value of the duty cycle that needs to be increased;

预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。After the preset time, the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed.

进一步地,所述基于所述当前速度以及当前占空比,计算所述当前占空比与当前速度的比值的步骤还可以为:Further, the step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be:

预设时间内多次获取移动机器人的当前速度以及当前占空比;Acquiring the current speed of the mobile robot and the current duty ratio multiple times within a preset time;

基于多次获取的移动机器人当前速度以及当前占空比,计算多次当前占空比与对应当前速度的比值;Calculating a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio;

基于多次当前占空比与对应当前速度的比值,计算当前占空比与对应当前速度的比值的平均值;Calculating an average value of a ratio of a current duty ratio to a corresponding current speed based on a ratio of the plurality of current duty ratios to a corresponding current speed;

将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值。The average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed.

进一步地,所述基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型的步骤包括:Further, the step of determining the current working surface type of the mobile robot based on the ratio of the current duty ratio to the current speed comprises:

基于当前占空比与当前速度的比值以及占空比与速度的比值和工作表面类型的映射表,得到当前工作表面类型。The current working surface type is obtained based on the ratio of the current duty ratio to the current speed and the ratio of duty ratio to speed and the type of work surface.

进一步地,所述移动机器人为扫地机器人,所述扫地机器人包括驱动轮或旋转毛刷。Further, the mobile robot is a sweeping robot, and the sweeping robot includes a driving wheel or a rotating brush.

进一步地,所述移动机器人为割草机器人,所述割草机器人包括驱动轮或旋转刀盘。Further, the mobile robot is a mowing robot, and the mowing robot includes a driving wheel or a rotating cutter.

本发明还提供了一种基于工作表面的移动机器人的控制方法,其方案如下:一种移动机器人的控制方法包括:The invention also provides a control method of a mobile robot based on a work surface, the scheme of which is as follows: A control method of the mobile robot comprises:

实时获取移动机器人的当前速度;Get the current speed of the mobile robot in real time;

当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比;Obtaining a current speed of the mobile robot and a current duty ratio when the current speed is greater than a preset speed;

基于所述当前速度以及当前占空比,计算当前占空比与当前速度的比值;Calculating a ratio of a current duty ratio to a current speed based on the current speed and a current duty ratio;

基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型;Determining a current working surface type of the mobile robot based on a ratio of the current duty ratio to a current speed;

根据工作表面类型控制移动机器人进入对应工作模式。The mobile robot is controlled to enter the corresponding working mode according to the type of the working surface.

进一步地,所述实时获取移动机器人的当前速度的步骤之前还包括:Further, the step of acquiring the current speed of the mobile robot in real time further includes:

预先设置移动机器人的正常工作速度、预设速度以及占空比与速度的比值和工作表面类型的映射表。A mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset.

进一步地,所述当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比的步骤还包括:Further, when the current speed is greater than the preset speed, the step of acquiring the current speed of the mobile robot and the current duty ratio further includes:

当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。When the current speed is not greater than the preset speed, the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed.

进一步地,所述当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度的步骤还包括:Further, when the current speed is not greater than the preset speed, the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further includes:

当所述当前速度不大于预设速度时,基于所述正常工作速度以及当前速度,计算所述正常工作速度与当前速度的速度差;Calculating a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed when the current speed is not greater than the preset speed;

基于所述速度差,计算要达到正常工作速度需要增加的占空比的值;Calculating a value of a duty ratio that needs to be increased to reach a normal operating speed based on the speed difference;

基于所述需要增加的占空比的值,调整移动机器人的当前速度;Adjusting the current speed of the mobile robot based on the value of the duty cycle that needs to be increased;

预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。After the preset time, the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed.

进一步地,所述基于所述当前速度以及当前占空比,计算所述当前占空比与当前速度的比值的步骤还可以为:Further, the step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be:

预设时间内多次获取移动机器人的当前速度以及当前占空比;Acquiring the current speed of the mobile robot and the current duty ratio multiple times within a preset time;

基于多次获取的移动机器人当前速度以及当前占空比,计算多次当前占空比与对应当前速度的比值;Calculating a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio;

基于多次当前占空比与对应当前速度的比值,计算当前占空比与对应当 前速度的比值的平均值;Calculating an average value of a ratio of a current duty ratio to a previous speed based on a ratio of a plurality of current duty ratios to a corresponding current speed;

将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值。The average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed.

本发明的目的之二在于克服背景技术中的缺陷,提供一种能精确识别工作表面类型且实施成本低的移动机器人,其方案如下:A second object of the present invention is to overcome the deficiencies in the background art, and to provide a mobile robot capable of accurately identifying a type of work surface and having a low implementation cost, and the scheme is as follows:

一种移动机器人,包括转动装置,包括获取模块、存储模块、判断模块和驱动模块;A mobile robot includes a rotating device, including an acquiring module, a storage module, a judging module and a driving module;

所述获取模块用于获取移动机器人的转动装置的当前速度以及当前占空比;The acquiring module is configured to acquire a current speed of the rotating device of the mobile robot and a current duty ratio;

所述存储模块用于存储移动机器人程序指令、占空比与速度的比值和工作表面类型的映射表;The storage module is configured to store a mapping table of mobile robot program instructions, a ratio of duty ratio to speed, and a type of work surface;

所述判断模块用于根据获取模块获取的转动装置的当前速度以及当前占空比,计算当前占空比与当前速度的比值;并基于当前占空比与当前速度的比值和存储模块中存储的转动装置的占空比与速度的比值和工作表面类型的映射表,确定移动机器人当前工作表面类型;The determining module is configured to calculate a ratio of a current duty ratio to a current speed according to a current speed of the rotating device acquired by the acquiring module and a current duty ratio; and based on a ratio of the current duty ratio to the current speed and the storage in the storage module Determining the ratio of duty cycle to speed of the rotating device and the mapping table of the working surface type to determine the current working surface type of the mobile robot;

所述驱动模块用于根据判断模块发出的指令驱使转动装置运行。The driving module is configured to drive the rotating device to operate according to an instruction issued by the determining module.

进一步地,所述获取模块包括用于获取转动装置速度的霍尔传感器或光电式测速传感器和用于获取转动装置占空比的单片机;Further, the acquisition module includes a Hall sensor or a photoelectric speed sensor for acquiring the speed of the rotating device and a single chip microcomputer for acquiring the duty ratio of the rotating device;

所述存储模块为单片机的存储器;The storage module is a memory of the single chip microcomputer;

所述判断模块为单片机;The determining module is a single chip microcomputer;

所述驱动模块为驱动IC。The drive module is a drive IC.

进一步地,所述移动机器人为割草机器人,所述转动装置为驱动轮或旋转刀盘。Further, the mobile robot is a mowing robot, and the rotating device is a driving wheel or a rotating cutter.

进一步地,所述移动机器人为扫地机器人,所述转动装置为驱动轮或旋转毛刷。Further, the mobile robot is a sweeping robot, and the rotating device is a driving wheel or a rotating brush.

本发明方案基于移动机器人在正常工作时,其转动装置在不同表面运行时,其占空比与速度的比值不同,通过实时检测移动机器人的转动装置的占空比与速度的比值来确定工作表面的类型,具有识别精度高且实施成本低的优点。The solution of the invention is based on the fact that the ratio of the duty ratio to the speed of the rotating device is different when the rotating device is operating on different surfaces during normal operation, and the working surface is determined by detecting the ratio of the duty ratio of the rotating device of the mobile robot to the speed in real time. The type has the advantages of high recognition accuracy and low implementation cost.

附图说明DRAWINGS

为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单的介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings used in the embodiments will be briefly described below. It is obvious that the drawings in the following description are some embodiments of the present invention. For the ordinary technicians, other drawings can be obtained based on these drawings without any creative work.

图1为本发明实施例提供的一种移动机器人的工作表面识别方法的流程图;1 is a flowchart of a working surface recognition method of a mobile robot according to an embodiment of the present invention;

图2为本发明实施例提供的控制移动机器人达到预设速度的方法的流程图;2 is a flowchart of a method for controlling a mobile robot to reach a preset speed according to an embodiment of the present invention;

图3为本发明实施例提供的计算当前占空比与当前速度的比值的方法流程图;3 is a flowchart of a method for calculating a ratio of a current duty ratio to a current speed according to an embodiment of the present invention;

图4为本发明实施例提供的一种移动机器人的模块结构示意图。FIG. 4 is a schematic structural diagram of a module of a mobile robot according to an embodiment of the present invention.

附图标记:100为转动装置、200为获取模块、300为存储模块、400为判断模块、500为驱动模块。Reference numerals: 100 is a rotating device, 200 is an acquisition module, 300 is a storage module, 400 is a determination module, and 500 is a drive module.

具体实施方式Detailed ways

下面将结合附图和具体实施例对本发明技术方案进行清楚、完整地描述,显然,这里所描述的实施例仅仅是发明的一部分实施例,而不是全部的实施例。基于本发明描述的具体实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明权利要求所限定的保护范围内。The technical solutions of the present invention will be clearly and completely described in the following with reference to the accompanying drawings and specific embodiments. It is obvious that the embodiments described herein are only a part of the embodiments of the invention, but not all embodiments. All other embodiments obtained by a person of ordinary skill in the art based on the specific embodiments described herein are intended to be within the scope of the invention as defined by the appended claims.

实施例1Example 1

本实施例中的移动机器人以扫地机器人为例进行说明。The mobile robot in this embodiment will be described by taking a sweeping robot as an example.

请参阅图1,图1为本发明实施例提供的一种移动机器人的工作表面识别方法的流程图。Please refer to FIG. 1. FIG. 1 is a flowchart of a method for identifying a working surface of a mobile robot according to an embodiment of the present invention.

如图1所示,一种移动机器人的工作表面识别方法可以包括以下步骤S100至S400。As shown in FIG. 1, a working surface recognition method of a mobile robot may include the following steps S100 to S400.

步骤S100:实时获取移动机器人的当前速度。Step S100: Acquire the current speed of the mobile robot in real time.

具体的,本实施例中以PID程序控制扫地机器人的驱动轮的占空比输出,设定扫地机器人正常工作时的速度给定值V(t),本实施例中为22cm/s。即无论在何种地面上,扫地机器人通过PID控制程序调整占空比,使得扫地机器人以V(t)作为正常工作时的速度。预先设置移动机器人的正常工作速度、预设速度以及占空比与速度的比值和工作表面类型的映射表。通过在扫地机器人的左右驱动轮(转动装置100)上的安装磁体(如磁铁)以及在驱动轮附近安装霍尔传感器,使得左右驱动轮转动时,霍尔传感器可周期性地检测到磁体并发送信号至单片机,单片机根据获取的信号计算出驱动轮当前速度V(角速度*驱动轮半径可得到驱动轮速度)。Specifically, in this embodiment, the duty cycle output of the driving wheel of the cleaning robot is controlled by the PID program, and the speed given value V(t) when the cleaning robot is normally operated is set, which is 22 cm/s in this embodiment. That is, no matter what kind of ground, the sweeping robot adjusts the duty ratio through the PID control program, so that the sweeping robot uses V(t) as the speed at normal working. A mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset. The Hall sensor periodically detects the magnet and transmits it by mounting a magnet (such as a magnet) on the left and right driving wheels (rotating device 100) of the cleaning robot and installing a Hall sensor near the driving wheel so that the left and right driving wheels rotate. The signal is sent to the single chip microcomputer, and the single chip computer calculates the current speed V of the driving wheel according to the obtained signal (the angular speed * the driving wheel radius can obtain the driving wheel speed).

步骤S200:当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比。Step S200: Acquire a current speed of the mobile robot and a current duty ratio when the current speed is greater than the preset speed.

具体的,然后判断当前速度V是否大于预设速度V0,V0略小于正常工作速度V(t)即可。当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。即如果当前速度V不大于V0,则认为扫地机器人处于非正常工作状态,将间隔一段时间(比如1秒)再次检测速度。Specifically, it is then determined whether the current speed V is greater than the preset speed V0, and V0 is slightly smaller than the normal working speed V(t). When the current speed is not greater than the preset speed, the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed. That is, if the current speed V is not greater than V0, the cleaning robot is considered to be in an abnormal working state, and the speed is detected again at intervals (for example, 1 second).

步骤S300:基于所述当前速度以及当前占空比,计算当前占空比与当前速度的比值。Step S300: Calculate a ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio.

具体的,当检测到扫地机器人的左右驱动轮的速度大于V0后,获取同一时刻驱动轮的速度V及驱动轮的占空比P,然后发送至单片机;单片机根据驱动轮的速度V及驱动轮的占空比P计算驱动轮的占空比P与驱动轮的速度V的比值。Specifically, when the speed of the left and right driving wheels of the cleaning robot is detected to be greater than V0, the speed V of the driving wheel at the same time and the duty ratio P of the driving wheel are acquired, and then sent to the single-chip microcomputer; the single-chip microcomputer according to the speed V of the driving wheel and the driving wheel The duty cycle P calculates the ratio of the duty cycle P of the drive wheel to the speed V of the drive wheel.

步骤S400:基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型。Step S400: Determine the current working surface type of the mobile robot based on the ratio of the current duty ratio to the current speed.

具体的,单片机通过计算同一时刻获取的占空比P与速度V的比值K,然后将K与存储在单片机的存储器内的占空比与速度的比值和工作表面类型的映射表进行对比,进而确定当前时刻扫地机器人所在地面的类型。Specifically, the single-chip microcomputer compares the ratio K between the duty ratio P and the speed V obtained at the same time, and then compares K with the ratio of the duty ratio to the speed stored in the memory of the single-chip microcomputer and the mapping table of the working surface type, and further Determine the type of surface where the sweeping robot is currently located.

请参阅图2,图2为本发明实施例提供的控制移动机器人达到预设速度的方法的流程图。Please refer to FIG. 2. FIG. 2 is a flowchart of a method for controlling a mobile robot to reach a preset speed according to an embodiment of the present invention.

如图2所示,控制移动机器人达到预设速度的方法可以包括以下步骤S210至S240。As shown in FIG. 2, the method of controlling the mobile robot to reach the preset speed may include the following steps S210 to S240.

步骤S210:当所述当前速度不大于预设速度时,基于所述正常工作速度以及当前速度,计算所述正常工作速度与当前速度的速度差。Step S210: When the current speed is not greater than the preset speed, calculate a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed.

具体的,扫地机器人启动后,PID控制程序给扫地机器人设定正常工作 速度V(t)=22cm/s,霍尔传感器将检测到的驱动轮的当前速度(此时为0)传输至单片机,当所述当前速度不大于预设速度V0时,计算所述正常工作速度V(t)与当前速度的速度差。Specifically, after the sweeping robot is started, the PID control program sets the normal working speed V(t)=22 cm/s to the sweeping robot, and the Hall sensor transmits the detected current speed of the driving wheel (in this case, 0) to the single chip microcomputer. When the current speed is not greater than the preset speed V0, the speed difference between the normal working speed V(t) and the current speed is calculated.

步骤S220:基于所述速度差,计算要达到正常工作速度需要增加的占空比的值。Step S220: Calculate a value of a duty ratio that needs to be increased to reach a normal working speed based on the speed difference.

具体的,基于速度差,然后PID控制程序根据速度差计算需要增加的占空比的值。Specifically, based on the speed difference, the PID control program then calculates the value of the duty cycle that needs to be increased based on the speed difference.

步骤S230:基于所述需要增加的占空比的值,调整移动机器人的当前速度。Step S230: Adjust the current speed of the mobile robot based on the value of the duty ratio that needs to be increased.

具体的,需要增加的占空比的值输出至驱动IC使驱动轮运动,调整移动机器人的当前速度。Specifically, the value of the duty ratio that needs to be increased is output to the driving IC to move the driving wheel, and the current speed of the mobile robot is adjusted.

步骤S240:预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。Step S240: After the preset time, the current speed of the mobile robot is acquired again and it is determined whether it is greater than the preset speed.

具体的,预设时间后霍尔传感器再将当前的驱动轮的实际速度(此时大于0,但仍然是一个较小值)传输至单片机,然后PID控制程序根据V(t)和当前速度的差值计算要增加的占空比,然后再输出至驱动IC使驱动轮运动,如此循环,直到检测到驱动轮的速度大于预设值V0(本实施例中V0为设置为18cm/s)。Specifically, after the preset time, the Hall sensor transmits the actual speed of the current driving wheel (at this time, greater than 0, but still a small value) to the MCU, and then the PID control program according to V(t) and the current speed. The difference is calculated by the duty ratio to be increased, and then output to the drive IC to move the drive wheel, and so on, until the speed of the drive wheel is detected to be greater than the preset value V0 (V0 is set to 18 cm/s in this embodiment).

该方法的主要目的是用于确认扫地机器人处于正常的连续工作状态,避免后续的误判。比如,在扫地机器人(移动机器人)在启动到正常工作阶段,由于惯性原因,转动装置100(驱动轮或旋转毛刷)的速度较小,为快速达到设定的速度V(t),PID控制程序的占空比输出高于正常工作时的占空比甚至满载,此时的占空比与速度的比值无参考价值。The main purpose of the method is to confirm that the sweeping robot is in a normal continuous working state and avoid subsequent misjudgment. For example, when the sweeping robot (mobile robot) is in the normal working phase, due to inertia, the speed of the rotating device 100 (drive wheel or rotating brush) is small, in order to quickly reach the set speed V(t), PID control The duty cycle output of the program is higher than the duty cycle or even full load during normal operation. The ratio of duty cycle to speed at this time has no reference value.

请参阅图3,图3为本发明实施例提供的计算当前占空比与当前速度的比值的方法流程图。Please refer to FIG. 3. FIG. 3 is a flowchart of a method for calculating a ratio of a current duty ratio to a current speed according to an embodiment of the present invention.

如图3所示,计算当前占空比与当前速度的比值的方法可以包括以下步骤S310至S340。As shown in FIG. 3, the method of calculating the ratio of the current duty ratio to the current speed may include the following steps S310 to S340.

步骤S310:预设时间内多次获取移动机器人的当前速度以及当前占空比。Step S310: Acquire the current speed of the mobile robot and the current duty ratio multiple times within a preset time.

具体的,可以在一段时间内多次获取驱动轮的速度Vi及占空比Pi,如在1秒内获取50次。Specifically, the speed Vi of the driving wheel and the duty ratio Pi can be obtained multiple times in a period of time, such as acquiring 50 times in 1 second.

步骤S320:基于多次获取的移动机器人当前速度以及当前占空比,计算多次当前占空比与对应当前速度的比值。Step S320: Calculate a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio.

具体的,根据一段时间内多次获取驱动轮的速度Vi及占空比Pi,计算每一次获取到的驱动轮的速度Vi及对应占空比Pi的当前占空比与对应当前速度的比值。Specifically, the speed Vi of the driving wheel and the ratio of the current duty ratio of the corresponding duty cycle Pi to the corresponding current speed are calculated according to the speed Vi and the duty ratio Pi of the driving wheel being acquired multiple times.

步骤S330:基于多次当前占空比与对应当前速度的比值,计算当前占空比与对应当前速度的比值的平均值。Step S330: Calculate an average value of the ratio of the current duty ratio to the corresponding current speed based on the ratio of the current duty ratio to the corresponding current speed.

具体的,根据多个当前占空比与对应当前速度的比值,计算该段时间内的驱动轮的占空比Pi与速度Vi比值Ki的平均值。Specifically, an average value of the duty ratio Pi of the driving wheel and the speed Vi ratio Ki in the period of time is calculated according to a ratio of the plurality of current duty ratios to the corresponding current speed.

步骤S340:将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值。Step S340: The average value of the ratio of the current duty ratio to the current speed is used as a ratio of the current duty ratio to the current speed.

具体的,将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值,能有效避免扫地机器人在运动过程中跨越门槛等短时间状态变化导致的对地面类型的误判。需要说明的是,此处的速度V及占空比P为数字信号,与通过检测电流获取的模拟信号相比,精确度更好。Specifically, the average value of the ratio of the current duty ratio to the current speed is used as the ratio of the current duty ratio to the current speed, which can effectively prevent the sweeping robot from crossing the threshold and other short-time state changes during the movement to the ground. Misjudgment of type. It should be noted that the speed V and the duty ratio P here are digital signals, and the accuracy is better than the analog signal obtained by detecting the current.

具体的,若所述移动机器人为扫地机器人,所述扫地机器人包括驱动轮 或旋转毛刷。Specifically, if the mobile robot is a sweeping robot, the sweeping robot includes a driving wheel or a rotating brush.

具体的,若所述移动机器人为割草机器人,所述割草机器人包括驱动轮或旋转刀盘。Specifically, if the mobile robot is a mowing robot, the mowing robot comprises a driving wheel or a rotating cutter.

在本实施例中,计算一段时间内的多次获取驱动轮的占空比Pi与速度Vi的比值Ki,再计算得到Ki的平均值;或一次获取驱动轮的占空比P与速度V的比值K。然后将K或Ki的平均值与存储在单片机的存储器内的预设的占空比与速度的比值和工作表面类型的映射表进行对比,进而判断当前时刻扫地机器人所在地面的类型。扫地机器人在普通地板工作上,驱动轮所受阻力较小,控制扫地机器人以22cm/s速度前进时的占空比约为25%,即平均1cm/s速度所需占空比1.126%;在普通地毯上,驱动轮所受阻力较大,控制扫地机器人以22cm/s速度前进的占空比约为52%,即平均1cm/s速度所需占空比2.36%;在长毛地毯上,控制扫地机器人以22cm/s速度前进的占空比约为75%,即平均1cm/s速度所需占空比3.41%。因此,可以通过将比值K与对应的地板表面类型对应起来,在比值K小于1.8时,判断在当前时刻或当前时间段内扫地机器人工作表面为地板;在比值K位于1.8至2.8时,判断在当前时刻或当前时间段内扫地机器人工作表面为普通地毯;在比值K位于2.8以上时,判断在当前时刻或当前时间段内扫地机器人工作表面为长毛地毯。In this embodiment, calculating the ratio Ki of the duty ratio Pi of the driving wheel and the speed Vi for a plurality of times in a period of time, and calculating the average value of Ki; or obtaining the duty ratio P and the speed V of the driving wheel at a time. Ratio K. Then, the average value of K or Ki is compared with the preset ratio of duty ratio to speed stored in the memory of the single chip microcomputer and the mapping table of the working surface type, thereby determining the type of the surface of the sweeping robot at the current time. The sweeping robot works on ordinary floor, the driving wheel is less resisted, and the duty ratio when controlling the sweeping robot to advance at 22cm/s is about 25%, that is, the duty ratio required for the average 1cm/s speed is 1.126%; On ordinary carpets, the driving wheel is subjected to a large resistance, and the duty ratio for controlling the sweeping robot to advance at a speed of 22 cm/s is about 52%, that is, the duty ratio required for an average speed of 1 cm/s is 2.36%; on a long-haired carpet, The duty ratio for controlling the sweeping robot to advance at a speed of 22 cm/s is about 75%, that is, the duty ratio required for an average speed of 1 cm/s is 3.41%. Therefore, by comparing the ratio K with the corresponding floor surface type, when the ratio K is less than 1.8, it is determined that the working surface of the sweeping robot is the floor at the current time or the current time period; when the ratio K is between 1.8 and 2.8, it is judged that The working surface of the sweeping robot is a normal carpet at the current time or the current time period; when the ratio K is above 2.8, it is judged that the working surface of the sweeping robot is a long-haired carpet at the current time or the current time period.

本实施例还提供了一种移动机器人的控制方法,根据上述一种移动机器人的工作表面识别方法获取移动机器人的工作表面类型,再根据工作表面类型控制移动机器人进入对应工作模式。The embodiment further provides a control method of the mobile robot. According to the working surface recognition method of the mobile robot, the working surface type of the mobile robot is obtained, and then the mobile robot is controlled to enter the corresponding working mode according to the working surface type.

具体的,单片机的存储器内存储有扫地机器人在不同地面清洁的的工作模式,并与占空比P与速度V的比值K阈值范围关联起来,扫地机器人根据某一时刻比值K或某段时间的比值Ki的平均值进入对应的工作模式。各模式 之间的差别包括:真空风机吸力不同、旋转毛刷转动速度不同以及清洁方式不同。从而针对性地清洁对应的地面,以达到更好的清洁效果及提高清洁效率。Specifically, the memory of the single-chip microcomputer stores the working mode of the cleaning robot on different grounds, and is associated with the threshold K ratio of the duty ratio P and the speed V, and the sweeping robot according to a certain time ratio K or a certain period of time The average value of the ratio Ki enters the corresponding working mode. The differences between the modes include: different suction forces of the vacuum fan, different rotational speeds of the rotating brushes, and different cleaning methods. Thereby, the corresponding ground is cleanly cleaned to achieve better cleaning effect and improve cleaning efficiency.

本实施例中,也可以通过检测扫地机器人的旋转毛刷的速度及占空比来实现对扫地机器人工作的地面类型进行识别,此时需要旋转毛刷持续接触地面,以检测不同地面的阻力。In this embodiment, the ground type of the working of the sweeping robot can also be recognized by detecting the speed and the duty ratio of the rotating brush of the cleaning robot. At this time, the rotating brush needs to continuously contact the ground to detect the resistance of different grounds.

如图4所示,图4为本发明实施例提供的一种移动机器人的模块结构示意图。As shown in FIG. 4, FIG. 4 is a schematic structural diagram of a module of a mobile robot according to an embodiment of the present invention.

如图4所示,本实施例中的扫地机器人包括转动装置100、获取模块200、存储模块300、判断模块400及驱动模块500。具体地,所述获取模块200用于获取移动机器人的转动装置100的当前速度以及当前占空比;所述存储模块300用于存储移动机器人程序指令、占空比与速度的比值和工作表面类型的映射表;所述判断模块400用于根据获取模块200获取的转动装置100的当前速度以及当前占空比,计算当前占空比与当前速度的比值;并基于当前占空比与当前速度的比值和存储模块300中存储的转动装置100的占空比与速度的比值和工作表面类型的映射表,确定移动机器人当前工作表面类型;所述驱动模块500用于根据判断模块400发出的指令驱使转动装置100运行。转动装置100为左右驱动轮;获取模块200包括用于获取驱动轮速度的霍尔传感器和获取驱动轮占空比的单片机;存储模块300为扫地机器人的单片机的存储器;判断模块400为单片机;驱动模块500为驱动IC。As shown in FIG. 4 , the cleaning robot in this embodiment includes a rotation device 100 , an acquisition module 200 , a storage module 300 , a determination module 400 , and a drive module 500 . Specifically, the acquiring module 200 is configured to acquire a current speed of the rotating device 100 of the mobile robot and a current duty ratio; the storage module 300 is configured to store a mobile robot program command, a ratio of duty ratio to speed, and a working surface type. The determining module 400 is configured to calculate a ratio of the current duty ratio to the current speed according to the current speed of the rotating device 100 acquired by the acquiring module 200 and the current duty ratio; and based on the current duty ratio and the current speed The ratio and the ratio of the ratio of the duty ratio of the rotating device 100 stored in the storage module 300 to the working surface type are determined, and the current working surface type of the mobile robot is determined; the driving module 500 is configured to be driven according to an instruction issued by the determining module 400. The rotating device 100 operates. The rotating device 100 is a left and right driving wheel; the obtaining module 200 includes a Hall sensor for acquiring the driving wheel speed and a single chip for obtaining the driving wheel duty ratio; the storage module 300 is a memory of the single chip microcomputer of the cleaning robot; the determining module 400 is a single chip microcomputer; Module 500 is a driver IC.

本实施例中的单片机植入PID程序来控制驱动轮的转速;单片机的存储器(即存储模块300)包括ROM和RAM,其中ROM用于存储移动机器人程序指令、转动装置100的占空比与速度的比值的阈值范围及对应的工作表面类型; RAM用于存储PID程序实时计算的占空比。单片机PID控制程序可直接读取和修改存储在RAM中的驱动轮的占空比,然后单片机输出占空比信息给驱动IC,通过驱动IC使驱动轮转动;霍尔传感器检测驱动轮速度并发送至单片机,通过与PID程序设置的驱动轮速度进行比较,然后根据比较结果增加或减少占空比,以控制驱动轮速度。The single-chip microcomputer in this embodiment is implanted with a PID program to control the rotational speed of the driving wheel; the memory of the single-chip microcomputer (ie, the storage module 300) includes a ROM and a RAM, wherein the ROM is used to store the mobile robot program instructions, the duty ratio and speed of the rotating device 100. The threshold range of the ratio and the corresponding work surface type; RAM is used to store the duty cycle of the PID program real-time calculation. The microcontroller PID control program can directly read and modify the duty cycle of the drive wheel stored in the RAM, and then the microcontroller outputs the duty cycle information to the drive IC, and the drive wheel is rotated by the drive IC; the Hall sensor detects the drive wheel speed and transmits To the microcontroller, compare the drive wheel speed set by the PID program, and then increase or decrease the duty cycle according to the comparison result to control the drive wheel speed.

本实施例中的转动装置100还可以为扫地机器人的旋转毛刷;用于获取驱动轮速度的获取模块200也可以采用光电式测速传感器。由于霍尔传感器及光电式测速传感器对于本领域技术人员来说是现有技术,因此不再对其实现过程进行描述。The rotating device 100 in this embodiment may also be a rotating brush of the cleaning robot; the acquiring module 200 for acquiring the driving wheel speed may also adopt a photoelectric speed measuring sensor. Since the Hall sensor and the photoelectric velocity sensor are prior art to those skilled in the art, the implementation process will not be described.

本发明实施例中扫地机器人识别地面类型的原理为:在扫地机器人驱动轮速度大于一定值且匀速运动时,驱动轮的占空比P在一个较小范围内变化,因此,驱动轮的占空比P与驱动轮的速度V(t)的比值也在一个较小范围内变化。当地面阻力突然增大,驱动轮负载突然增加,驱动轮占空比还未及时更新时,驱动轮速度会降低,为了使驱动轮速度保持在设定值,驱动轮的占空比P会增加;当驱动轮速度V达到设定值V(t),驱动轮速度V保持不变,驱动轮占空比增加,驱动轮的占空比P与驱动轮的速度V的比值K会增加;当地面阻力突然减小,驱动轮负载突然减少,驱动轮占空比还未及时更新时,驱动轮速度会增加,为了使驱动轮速度保持在设定值,驱动轮的占空比P会减小;当驱动轮速度V达到设定值V(t),驱动轮速度V保持不变,驱动轮占空比减小,驱动轮的占空比P与驱动轮的速度V的比值K会减小;因此,驱动轮的占空比与速度的比值可以代表驱动轮当前地面的阻力大小,进而可根据地面阻力大小来判断地面类型。In the embodiment of the present invention, the principle that the sweeping robot recognizes the ground type is: when the driving speed of the sweeping robot is greater than a certain value and the uniform speed is moved, the duty ratio P of the driving wheel changes within a small range, and therefore, the driving wheel is occupied. The ratio of the ratio P to the speed V(t) of the drive wheel also varies within a small range. When the ground resistance suddenly increases, the driving wheel load suddenly increases, and the driving wheel duty ratio has not been updated in time, the driving wheel speed will decrease. In order to keep the driving wheel speed at the set value, the driving wheel duty cycle P will increase. When the driving wheel speed V reaches the set value V(t), the driving wheel speed V remains unchanged, the driving wheel duty ratio increases, and the ratio K of the driving wheel duty ratio P to the driving wheel speed V increases; The surface resistance suddenly decreases, the driving wheel load suddenly decreases, and the driving wheel speed is not updated in time. The driving wheel speed will increase. In order to keep the driving wheel speed at the set value, the driving wheel duty cycle P will decrease. When the driving wheel speed V reaches the set value V(t), the driving wheel speed V remains unchanged, the driving wheel duty ratio decreases, and the ratio K of the driving wheel duty ratio P to the driving wheel speed V decreases. Therefore, the ratio of the duty cycle to the speed of the driving wheel can represent the resistance of the current ground of the driving wheel, and the ground type can be judged according to the magnitude of the ground resistance.

实施例2Example 2

本实施例中的移动机器人以割草机器人为例进行说明。The mobile robot in this embodiment will be described by taking a mowing robot as an example.

本实施例中的割草机器人包括转动装置100、获取模块200、存储模块300、判断模块400以及驱动模块500。具体地,本实施例中的转动装置100为驱动轮或旋转刀盘;本实施例获取模块200包括用于获取驱动轮或旋转刀盘转速的霍尔传感器;存储模块300为割草机器人的单片机的存储器;判断模块400为单片机。The mowing robot in this embodiment includes a rotation device 100, an acquisition module 200, a storage module 300, a determination module 400, and a drive module 500. Specifically, the rotating device 100 in this embodiment is a driving wheel or a rotating cutter head; the acquisition module 200 of the embodiment includes a Hall sensor for acquiring the rotational speed of the driving wheel or the rotating cutter head; and the storage module 300 is a single-chip microcomputer for the mowing robot. The memory of the determination module 400 is a single chip microcomputer.

本实施例中割草机器人的草坪类型识别方法与实施例1中识别地面类型基本相同,不同的地方在于:可以通过检测割草机器人的旋转刀盘转速及占空比来检测割草机器人工作的草坪状况,然后进入对应的割草模式以提高割草效果及效率。The lawn type identification method of the mowing robot in this embodiment is basically the same as the ground type identified in the embodiment 1. The difference is that the mowing robot can be detected by detecting the rotation speed and duty ratio of the rotary cutter head of the mowing robot. The condition of the lawn, then enter the corresponding mowing mode to improve the mowing effect and efficiency.

基于割草机器人的工作草坪状况识别的原理为:草坪高度越高,驱动轮及旋转刀盘受到的阻力越大,在保持驱动轮速度或旋转刀盘转速在设定值时,驱动轮或旋转刀盘的占空比越大,表明草坪越高。The principle of working lawn condition recognition based on mowing robot is: the higher the height of the lawn, the greater the resistance of the driving wheel and the rotating cutter head, and the driving wheel or rotation while maintaining the driving wheel speed or the rotating cutter wheel speed at the set value. The greater the duty cycle of the cutterhead, the higher the lawn.

以上所揭露的仅为本发明技术方案的实施例而已,不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。The above is only the embodiment of the present invention, and the scope of the present invention is not limited thereto, and thus equivalent changes made in the claims of the present invention are still within the scope of the present invention.

以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-described embodiments may be arbitrarily combined. For the sake of brevity of description, all possible combinations of the technical features in the above embodiments are not described. However, as long as there is no contradiction between the combinations of these technical features, All should be considered as the scope of this manual.

以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围 应以所附权利要求为准。The above-described embodiments are merely illustrative of several embodiments of the present invention, and the description thereof is more specific and detailed, but is not to be construed as limiting the scope of the invention. It should be noted that a number of variations and modifications may be made by those skilled in the art without departing from the spirit and scope of the invention. Therefore, the scope of the invention should be determined by the appended claims.

Claims (17)

一种移动机器人的工作表面识别方法,其特征在于,包括:A working surface recognition method for a mobile robot, comprising: 实时获取移动机器人的当前速度;Get the current speed of the mobile robot in real time; 当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比;Obtaining a current speed of the mobile robot and a current duty ratio when the current speed is greater than a preset speed; 基于所述当前速度以及当前占空比,计算当前占空比与当前速度的比值;Calculating a ratio of a current duty ratio to a current speed based on the current speed and a current duty ratio; 基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型。A current working surface type of the mobile robot is determined based on a ratio of the current duty ratio to the current speed. 根据权利要求1所述的方法,其特征在于,所述实时获取移动机器人的当前速度的步骤之前还包括:The method according to claim 1, wherein the step of acquiring the current speed of the mobile robot in real time further comprises: 预先设置移动机器人的正常工作速度、预设速度以及占空比与速度的比值和工作表面类型的映射表。A mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset. 根据权利要求2所述的方法,其特征在于,所述当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比的步骤还包括:The method according to claim 2, wherein the step of acquiring the current speed of the mobile robot and the current duty ratio when the current speed is greater than the preset speed further comprises: 当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。When the current speed is not greater than the preset speed, the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed. 根据权利要求3所述的方法,其特征在于,所述当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度的步骤还包括:The method according to claim 3, wherein when the current speed is not greater than the preset speed, the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further comprises: 当所述当前速度不大于预设速度时,基于所述正常工作速度以及当前速度,计算所述正常工作速度与当前速度的速度差;Calculating a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed when the current speed is not greater than the preset speed; 基于所述速度差,计算要达到正常工作速度需要增加的占空比的值;Calculating a value of a duty ratio that needs to be increased to reach a normal operating speed based on the speed difference; 基于所述需要增加的占空比的值,调整移动机器人的当前速度;Adjusting the current speed of the mobile robot based on the value of the duty cycle that needs to be increased; 预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。After the preset time, the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed. 根据权利要求2所述的方法,其特征在于,所述基于所述当前速度以及当前占空比,计算所述当前占空比与当前速度的比值的步骤还可以为:The method according to claim 2, wherein the step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be: 预设时间内多次获取移动机器人的当前速度以及当前占空比;Acquiring the current speed of the mobile robot and the current duty ratio multiple times within a preset time; 基于多次获取的移动机器人当前速度以及当前占空比,计算多次当前占空比与对应当前速度的比值;Calculating a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio; 基于多次当前占空比与对应当前速度的比值,计算当前占空比与对应当前速度的比值的平均值;Calculating an average value of a ratio of a current duty ratio to a corresponding current speed based on a ratio of the plurality of current duty ratios to a corresponding current speed; 将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值。The average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed. 根据权利要求1所述的方法,其特征在于,所述基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型的步骤包括:The method according to claim 1, wherein the step of determining the current working surface type of the mobile robot based on the ratio of the current duty ratio to the current speed comprises: 基于当前占空比与当前速度的比值以及占空比与速度的比值和工作表面类型的映射表,得到当前工作表面类型。The current working surface type is obtained based on the ratio of the current duty ratio to the current speed and the ratio of duty ratio to speed and the type of work surface. 根据权利要求1所述的方法,其特征在于:The method of claim 1 wherein: 所述移动机器人为扫地机器人,所述扫地机器人包括驱动轮或旋转毛刷。The mobile robot is a sweeping robot, and the sweeping robot includes a driving wheel or a rotating brush. 根据权利要求1所述的方法,其特征在于:The method of claim 1 wherein: 所述移动机器人为割草机器人,所述割草机器人包括驱动轮或旋转刀盘。The mobile robot is a mowing robot, and the mowing robot includes a drive wheel or a rotary cutter. 一种移动机器人的控制方法,其特征在于,包括:A method for controlling a mobile robot, comprising: 实时获取移动机器人的当前速度;Get the current speed of the mobile robot in real time; 当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比;Obtaining a current speed of the mobile robot and a current duty ratio when the current speed is greater than a preset speed; 基于所述当前速度以及当前占空比,计算当前占空比与当前速度的比值;Calculating a ratio of a current duty ratio to a current speed based on the current speed and a current duty ratio; 基于所述当前占空比与当前速度的比值,判断移动机器人当前工作表面类型;Determining a current working surface type of the mobile robot based on a ratio of the current duty ratio to a current speed; 根据工作表面类型控制移动机器人进入对应工作模式。The mobile robot is controlled to enter the corresponding working mode according to the type of the working surface. 根据权利要求9所述的方法,其特征在于,所述实时获取移动机器人的当前速度的步骤之前还包括:The method according to claim 9, wherein the step of acquiring the current speed of the mobile robot in real time further comprises: 预先设置移动机器人的正常工作速度、预设速度以及占空比与速度的比值和工作表面类型的映射表。A mapping table of the normal working speed, the preset speed, and the ratio of the duty ratio to the speed and the type of the working surface of the mobile robot is preset. 根据权利要求10所述的方法,其特征在于,所述当所述当前速度大于预设速度时,获取移动机器人的当前速度以及当前占空比的步骤还包括:The method according to claim 10, wherein the step of acquiring the current speed of the mobile robot and the current duty ratio when the current speed is greater than the preset speed further comprises: 当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。When the current speed is not greater than the preset speed, the current speed of the mobile robot is acquired again after the preset time and it is determined whether it is greater than the preset speed. 根据权利要求11所述的方法,其特征在于,所述当所述当前速度不大于预设速度时,预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度的步骤还包括:The method according to claim 11, wherein when the current speed is not greater than the preset speed, the step of acquiring the current speed of the mobile robot again after the preset time and determining whether it is greater than the preset speed further comprises: 当所述当前速度不大于预设速度时,基于所述正常工作速度以及当前速度,计算所述正常工作速度与当前速度的速度差;Calculating a speed difference between the normal working speed and the current speed based on the normal working speed and the current speed when the current speed is not greater than the preset speed; 基于所述速度差,计算要达到正常工作速度需要增加的占空比的值;Calculating a value of a duty ratio that needs to be increased to reach a normal operating speed based on the speed difference; 基于所述需要增加的占空比的值,调整移动机器人的当前速度;Adjusting the current speed of the mobile robot based on the value of the duty cycle that needs to be increased; 预设时间后再次获取移动机器人的当前速度并判断是否大于预设速度。After the preset time, the current speed of the mobile robot is acquired again and it is judged whether it is greater than the preset speed. 根据权利要求10所述的方法,其特征在于,所述基于所述当前速度以及当前占空比,计算所述当前占空比与当前速度的比值的步骤还可以为:The method according to claim 10, wherein the step of calculating the ratio of the current duty ratio to the current speed based on the current speed and the current duty ratio may further be: 预设时间内多次获取移动机器人的当前速度以及当前占空比;Acquiring the current speed of the mobile robot and the current duty ratio multiple times within a preset time; 基于多次获取的移动机器人当前速度以及当前占空比,计算多次当前占 空比与对应当前速度的比值;Calculating a ratio of the current duty ratio to the corresponding current speed based on the current speed of the mobile robot acquired multiple times and the current duty ratio; 基于多次当前占空比与对应当前速度的比值,计算当前占空比与对应当前速度的比值的平均值;Calculating an average value of a ratio of a current duty ratio to a corresponding current speed based on a ratio of the plurality of current duty ratios to a corresponding current speed; 将所述当前占空比与对应当前速度的比值的平均值作为当前占空比与当前速度的比值。The average value of the ratio of the current duty ratio to the current speed is taken as the ratio of the current duty ratio to the current speed. 一种移动机器人,包括转动装置(100),其特征在于:A mobile robot comprising a rotating device (100), characterized in that: 包括获取模块(200)、存储模块(300)、判断模块(400)和驱动模块(500);The method includes an obtaining module (200), a storage module (300), a determining module (400), and a driving module (500); 所述获取模块(200)用于获取移动机器人的转动装置(100)的当前速度以及当前占空比;The obtaining module (200) is configured to acquire a current speed of the rotating device (100) of the mobile robot and a current duty ratio; 所述存储模块(300)用于存储移动机器人程序指令、占空比与速度的比值和工作表面类型的映射表;The storage module (300) is configured to store a mapping table of mobile robot program instructions, a ratio of duty ratio to speed, and a type of work surface; 所述判断模块(400)用于根据获取模块(200)获取的转动装置(100)的当前速度以及当前占空比,计算当前占空比与当前速度的比值;并基于当前占空比与当前速度的比值和存储模块(300)中存储的转动装置(100)的占空比与速度的比值和工作表面类型的映射表,确定移动机器人当前工作表面类型;The determining module (400) is configured to calculate a ratio of a current duty ratio to a current speed according to a current speed of the rotating device (100) acquired by the acquiring module (200) and a current duty ratio; and based on the current duty ratio and the current Determining the current working surface type of the mobile robot by the ratio of the speed and the ratio of the duty ratio of the rotating device (100) stored in the storage module (300) to the working surface type; 所述驱动模块(500)用于根据判断模块发出的指令驱使转动装置运行。The driving module (500) is configured to drive the rotating device to operate according to an instruction issued by the determining module. 根据权利要求14所述的移动机器人,其特征在于:A mobile robot according to claim 14, wherein: 所述获取模块(200)包括用于获取转动装置(100)速度的霍尔传感器或光电式测速传感器和用于获取转动装置(100)占空比的单片机;The acquisition module (200) includes a Hall sensor or a photoelectric speed sensor for acquiring the speed of the rotating device (100) and a single chip microcomputer for acquiring the duty ratio of the rotating device (100); 所述存储模块(300)为单片机的存储器;The storage module (300) is a memory of the single chip microcomputer; 所述判断模块(400)为单片机;The determining module (400) is a single chip microcomputer; 所述驱动模块(500)为驱动IC。The drive module (500) is a drive IC. 根据权利要求14所述的移动机器人,其特征在于:A mobile robot according to claim 14, wherein: 所述移动机器人为割草机器人,所述转动装置(100)为驱动轮或旋转刀盘。The mobile robot is a mowing robot, and the rotating device (100) is a drive wheel or a rotary cutter. 根据权利要求14所述的移动机器人,其特征在于:A mobile robot according to claim 14, wherein: 所述移动机器人为扫地机器人,所述转动装置(100)为驱动轮或旋转毛刷。The mobile robot is a sweeping robot, and the rotating device (100) is a driving wheel or a rotating brush.
PCT/CN2018/073805 2017-07-05 2018-01-23 Mobile robot, working surface recognition method and control method Ceased WO2019007037A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201710543225.5A CN109202891B (en) 2017-07-05 2017-07-05 Mobile robot, work surface identification method and control method
CN201710543225.5 2017-07-05

Publications (1)

Publication Number Publication Date
WO2019007037A1 true WO2019007037A1 (en) 2019-01-10

Family

ID=64950573

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2018/073805 Ceased WO2019007037A1 (en) 2017-07-05 2018-01-23 Mobile robot, working surface recognition method and control method

Country Status (2)

Country Link
CN (1) CN109202891B (en)
WO (1) WO2019007037A1 (en)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111493747A (en) * 2019-01-31 2020-08-07 北京奇虎科技有限公司 Control method and device of sweeping robot and electronic equipment
CN109997493A (en) * 2019-04-15 2019-07-12 杭州晶一智能科技有限公司 Grass-removing robot is based on motor load and carries out careless condition recognition methods
CN111938510A (en) * 2019-05-17 2020-11-17 广东宝乐机器人股份有限公司 Cleaning robot, surface type detection method and control method
CN110897554A (en) * 2019-11-08 2020-03-24 微思机器人(深圳)有限公司 Sweeper control method based on ultrasonic waves and sweeper
CN112971643B (en) * 2019-12-17 2023-04-07 科沃斯机器人股份有限公司 Detection method, robot, and storage medium
CA3167246A1 (en) * 2020-02-07 2021-08-12 Texaroba Technology Inc. Robotic lawn mower of non-traditional cutter
CN111670676B (en) * 2020-05-13 2022-06-03 惠州拓邦电气技术有限公司 Grass mower and control method and control device thereof
CN111839331B (en) * 2020-06-20 2022-07-08 珠海一微半导体股份有限公司 Method for predicting best working fan suction of robot
CN111839332B (en) * 2020-06-20 2022-07-08 珠海一微半导体股份有限公司 Control method of intelligent window cleaning machine and intelligent window cleaning machine
CN111887768B (en) * 2020-06-20 2022-07-08 珠海一微半导体股份有限公司 Method for determining dust collection wind power and performing dust collection control of sweeping robot
CN114246507B (en) * 2020-09-23 2022-11-25 江苏美的清洁电器股份有限公司 Type determination method and device, electronic equipment and storage medium
CN120044947A (en) * 2021-07-16 2025-05-27 速感科技(北京)有限公司 Ground material identification method, control method, device and storage medium
CN114146797A (en) * 2021-10-14 2022-03-08 李长辉 Composite crushing structure current analysis platform

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07250793A (en) * 1994-03-14 1995-10-03 Matsushita Electric Ind Co Ltd Vacuum cleaner controller
CN1891132A (en) * 2005-07-04 2007-01-10 陈东明 Controlling method for control system of smart cleaner
CN101053955A (en) * 2007-04-06 2007-10-17 江南大学 Control device for moving robot based on blue-tooth technology
CN104407614A (en) * 2014-10-23 2015-03-11 河北工业大学 Four-wheel type indoor mobile robot
CN104905728A (en) * 2015-06-17 2015-09-16 上海缘盟自动化技术有限公司 Swing type self-walking window-cleaning robot and control method thereof
CN205091616U (en) * 2015-02-13 2016-03-16 美国iRobot公司 Move ground and clean machine people with floor type detects

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1155787B1 (en) * 1998-11-30 2016-10-05 Sony Corporation Robot device and control method thereof
JP2005013460A (en) * 2003-06-26 2005-01-20 Matsushita Electric Ind Co Ltd Rechargeable vacuum cleaner
TW201207243A (en) * 2010-08-06 2012-02-16 Hon Hai Prec Ind Co Ltd Method and system for controlling rotation speed of fans
CN106393094A (en) * 2015-07-30 2017-02-15 苏州宝时得电动工具有限公司 Automatic moving robot
CN106125742B (en) * 2016-08-30 2019-04-09 宁波菜鸟智能科技有限公司 Ambulation control method, the apparatus and system of robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07250793A (en) * 1994-03-14 1995-10-03 Matsushita Electric Ind Co Ltd Vacuum cleaner controller
CN1891132A (en) * 2005-07-04 2007-01-10 陈东明 Controlling method for control system of smart cleaner
CN101053955A (en) * 2007-04-06 2007-10-17 江南大学 Control device for moving robot based on blue-tooth technology
CN104407614A (en) * 2014-10-23 2015-03-11 河北工业大学 Four-wheel type indoor mobile robot
CN205091616U (en) * 2015-02-13 2016-03-16 美国iRobot公司 Move ground and clean machine people with floor type detects
CN104905728A (en) * 2015-06-17 2015-09-16 上海缘盟自动化技术有限公司 Swing type self-walking window-cleaning robot and control method thereof

Also Published As

Publication number Publication date
CN109202891B (en) 2020-12-15
CN109202891A (en) 2019-01-15

Similar Documents

Publication Publication Date Title
WO2019007037A1 (en) Mobile robot, working surface recognition method and control method
KR100560966B1 (en) How to calibrate gyro sensor of robot cleaner
US11006804B2 (en) Automatically traveling floor cleaning appliance and method for operating a floor cleaning appliance
US20140166047A1 (en) Traveling cleaning appliance and method for operating such an appliance
CN108594692A (en) A kind of cleaning equipment control method, device, computer equipment and storage medium
WO2019052285A1 (en) Detection method for robot skidding, map building method, and chip
JP2017074191A (en) Electric vacuum cleaner
KR20130002218A (en) Robot cleaner and control method thereof
CN111938510A (en) Cleaning robot, surface type detection method and control method
CN112515537B (en) Walking ground recognition method and cleaning robot
CN110831473A (en) Method for adjusting the suction power of a cordless broom cleaner
CN108451443A (en) A kind of detection method, device and the dust catcher of dust catcher plug-hole
CN108888188B (en) Sweeping robot position calibration method and system
WO2017036401A1 (en) Electric tool controlling method and apparatus, and electric tool
CN108065866A (en) A kind of automatic pointing sweeping machine and method
CN118141289A (en) Control method of cleaning equipment and cleaning equipment
CN107664748B (en) Method and chip for robot inspection of carpet
CN113287969A (en) Method for judging type of cleaning surface, method for adjusting cleaning mode, and cleaning apparatus
CN114608849A (en) Sweeper state detection method and device, electronic equipment and storage medium
WO2023159788A1 (en) Automatic adjusting method, apparatus and system for gear of handheld cleaning device, and storage medium
EP4512580A1 (en) Robotic device for identifying movement path using reliability values, and method for controlling same
CN110442123B (en) Cleaning robot, cleaning method, environment monitoring method, and computer storage medium
CN114911229B (en) Positioning correction method, device, self-moving equipment and system
CN111493741A (en) Dust box detection method, device, electronic device and computer readable storage medium
CN110868127A (en) Motor speed pulse frequency conversion method, computer readable storage medium and motor

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: 18828373

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 18828373

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 18828373

Country of ref document: EP

Kind code of ref document: A1