WO2020047746A1 - Mobile robot control method and system, and mobile robot - Google Patents
Mobile robot control method and system, and mobile robot Download PDFInfo
- Publication number
- WO2020047746A1 WO2020047746A1 PCT/CN2018/103979 CN2018103979W WO2020047746A1 WO 2020047746 A1 WO2020047746 A1 WO 2020047746A1 CN 2018103979 W CN2018103979 W CN 2018103979W WO 2020047746 A1 WO2020047746 A1 WO 2020047746A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- robot
- current
- control
- control instruction
- state
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000033001 locomotion Effects 0.000 claims abstract description 60
- 230000001133 acceleration Effects 0.000 claims description 51
- 238000010586 diagram Methods 0.000 description 6
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000001747 exhibiting effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
Definitions
- Embodiments of the present invention relate to the field of control, and in particular, to a control method and system for a mobile robot, and a mobile robot.
- a first aspect of an embodiment of the present invention is to provide a method for controlling a mobile robot, the method including:
- a second aspect of the embodiments of the present invention is to provide a mobile robot, the mobile robot includes: a main control terminal and an execution terminal;
- the main control terminal is configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current state of the robot's mobility performance according to the control instruction and the current execution state of the control instruction, or Adjusting at least one of a current control performance state of the robot according to at least one of a current environment of the robot, a current maneuverability state of the robot, or a current control performance state of the robot;
- the execution end is configured to adjust the movement of the robot according to the adjusted control instruction.
- a third aspect of the embodiments of the present invention is to provide a mobile robot control system.
- the control system includes a remote control terminal and a mobile robot, and the remote control terminal is configured to generate a control instruction and send the control instruction to the mobile robot.
- the mobile robot includes: a main control terminal and an execution terminal;
- the main control terminal is configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current state of the robot's mobility performance according to the control instruction and the current execution state of the control instruction, or Adjusting at least one of a current control performance state of the robot according to at least one of a current environment of the robot, a current maneuverability state of the robot, or a current control performance state of the robot;
- the execution end is configured to adjust the movement of the robot according to the adjusted control instruction.
- the mobile robot control method, control system and mobile robot provided by the embodiments of the present invention determine at least one of the current environment of the robot, the current mobility performance status of the robot, or the current control performance status of the robot by determining the current execution status of the control instruction. Item to adjust the control instruction to adjust the movement of the robot in real time. It can be seen that the mobile robot control method, control system, and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, thereby exhibiting stable maneuverability, thereby improving Control efficiency and safety of mobile robots.
- FIG. 1 is a motion diagram of a wheeled mobile robot on different roads provided in the prior art.
- FIG. 2 is a flowchart of a mobile robot control method according to an embodiment of the present invention.
- FIG. 3 is a schematic diagram of a mobile robot control system according to an embodiment of the present invention.
- FIG. 4 is a schematic diagram of a master terminal according to an embodiment of the present invention.
- FIG. 5 is a schematic diagram of a remote control terminal according to an embodiment of the present invention.
- FIG. 1 is a schematic diagram of a wheeled mobile robot on different roads provided in the prior art, including a remote control terminal 101 and a mobile robot terminal 102.
- the remote control terminal 101 sends a control instruction to the mobile robot terminal 102, and the mobile robot terminal 102 controls the movement of the wheeled mobile robot according to the control instruction.
- the operator needs to manually adjust the control instructions.
- the mobile robot control method, control system and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, and exhibit stable maneuverability, thereby improving the control of the mobile robot. Efficiency and safety.
- FIG. 2 is a flowchart of a method for controlling a mobile robot according to an embodiment of the present invention.
- the mobile robot described in this embodiment may specifically be a wheeled mobile robot, an unmanned aerial vehicle, or an unmanned ship.
- Step S201 Obtain a control instruction sent by the remote terminal.
- control instruction in this embodiment includes one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
- Step S202 Determine a current execution state of the control instruction.
- determining the current execution state of the control instruction includes: acquiring current motion parameters, wherein the motion parameters include one or more of a current speed, acceleration, position, and attitude of the robot.
- determining the current execution state of the control instruction includes: obtaining current maneuverability parameters, wherein the maneuverability parameters include one or more of a current rotation speed and a torque of the motor.
- determining the current execution status of the control instruction includes: obtaining a current control performance parameter, wherein the control performance parameter includes one or more of an adjustment time and an error range.
- the adjustment time is the time when the actual output of the robot stabilizes within a preset range
- the error range is the error of the actual output of the robot relative to the target output of the control instruction. For example, if the control instruction is a speed instruction of 5m / s and the preset range is 5m / s ⁇ 10%, the adjustment time is the time when the actual speed stabilizes from the original speed to 4.5m / s-5.5m / s.
- step S203 at least one of the environment in which the robot is currently located, the current state of the robotic performance of the robot, or the current state of the control performance of the robot is determined according to the control instruction and the current execution state of the control instruction.
- the current motion parameter is compared with a first threshold to obtain the current environment of the robot, wherein the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
- the current maneuverability parameter of the robot is obtained by comparing the current maneuverability parameter with a second threshold, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
- the current control performance parameter is compared with a third threshold value to obtain the current control performance state of the robot, wherein the third threshold value is a control performance parameter corresponding to the control instruction under a standard environment.
- the corresponding motion parameters, maneuverability parameters, and control performance parameters of the control instruction in a standard environment are obtained through calibration experiments or simulation calculations.
- the simulation can model the dynamic environment and kinematics, describe different environmental states with parameters such as road friction coefficient, and derive control instructions and motion parameters in different environments. Maneuverability parameters, the mapping relationship between control performance parameters.
- Step S204 adjusting the control instruction according to at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot, so that the execution end adjusts according to the adjusted control instruction The movement of the robot.
- the current environment of the robot is a standard environment
- the current state of the robot's maneuverability is good
- the current state of the robot's control performance is good
- the current maneuver of the robot At least one of a performance state or a current control performance state of the robot, and adjusting the control instruction includes maintaining the control instruction unchanged.
- the current status of the robot Adjusting the control instruction includes at least one of a maneuverability state or a current control performance state of the robot, including: reducing a current acceleration and / or speed.
- the non-standard environment includes bumpy roads, smooth roads, and muddy roads.
- a wheeled mobile robot when the motor speed of the robot is high and the torque is small, that is, the motor speed to torque ratio is too large, the attitude adjustment time is too long, the Z-axis acceleration appears high amplitude vibration, and the wheel is frequently suspended, Determine the current environment of the robot as a bumpy road; when the motor speed is high and the torque is small, that is, the motor speed to torque ratio is too large, the speed adjustment time and attitude adjustment time are longer, and the Z-axis acceleration changes gently, and the robot is in the starting and braking stages.
- the skid When the skid is frequent, it can be judged that the current environment of the robot is a smooth road; when the motor speed is low and the torque is large, that is, the motor speed to torque ratio is small, the speed adjustment time and attitude adjustment time are long, and the wheel is subject to greater resistance, the Determine the current environment of the robot as a muddy road.
- reducing the current acceleration and / or speed includes reducing the current acceleration and speed to alleviate the vibration of the robot on the bumpy road. If the non-standard environment is a smooth road, reducing the current acceleration and / or speed includes reducing the current acceleration so that the robot speed matches the wheel speed. If the non-standard environment is a muddy road, reducing the current acceleration and / or speed includes reducing the current acceleration and / or speed so that the robot can run slowly and steadily.
- the current environment of the robot is divided into a standard environment and a non-standard environment.
- the non-standard environment includes bumpy roads, smooth roads, and muddy roads.
- the current environment of the robot can be expanded into more scenes according to the type and actual needs of the mobile robot, and divided into different levels according to different scenes, and is not limited to the text form, and can be set according to actual needs.
- the scene of bumps can be divided into different levels from 1 to 10. The larger the number, the more severe the bump.
- other scenes such as smooth and muddy can also be divided into more levels to describe the environment in which the robot is currently in more detail.
- the maneuverability state and the control performance state are described only by taking the bad as an example.
- the current maneuverability state of the robot and the current state of the control performance of the robot can be expanded by more levels as needed. It can be understood that the specific content of the adjusted control instruction is not limited to reducing the acceleration and / or speed described in the embodiment, and the content of the control instruction and the actual application scenario can be expanded into more types according to the type of the mobile robot.
- the mobile robot control method further includes:
- Obtaining a feedback amount which includes one or more of a motor speed, a motor torque, a robot speed, a robot acceleration, a robot position, and a robot posture;
- the movement of the robot is further adjusted according to the feedback amount and the adjusted control instruction.
- the mobile robot control method further includes sending at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot to the remote control end.
- Sending at least one of the current environment of the robot, the current mobile performance state of the robot, or the current control performance state of the robot to the remote control terminal can make the remote control terminal know the current state of the robot in time. While the robot adaptively adjusts its own motion, the remote control can adjust the robot's motion based on the information sent.
- the method for controlling a mobile robot provided by an embodiment of the present invention is to determine at least one of the current environment of the robot, the current state of the mobile performance of the robot, or the current state of the control performance of the robot by determining the current execution state of the control instruction to adjust the state. Control instructions to adjust robot movement in real time. It can be seen that the mobile robot control method provided by the embodiment of the present invention enables the mobile robot to adaptively adjust its own motion when it enters different environments and exhibits stable maneuverability, thereby improving the control efficiency of the mobile robot and safety.
- FIG. 3 is a schematic diagram of a mobile robot control system according to an embodiment of the present invention.
- the mobile robot described in this embodiment may be a wheeled mobile robot, an unmanned aerial vehicle, or an unmanned ship.
- the control system includes a mobile robot 30 and a remote control terminal 31.
- the mobile robot 30 includes a main control terminal 301, an execution terminal 302, and a sensor 303.
- the remote terminal 31 is used to generate a control instruction and send it to the mobile robot 30.
- control instruction includes one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
- the main control terminal 301 is configured to obtain a control instruction sent by the remote control terminal 31, determine the current execution status of the control instruction, and determine the current environment of the robot and the current maneuver of the robot according to the control instruction and the current execution status of the control instruction. At least one of a performance state or a current control performance state of the robot, and the control instruction is adjusted according to at least one of an environment in which the robot is currently located, a current maneuverability state of the robot, or a current control performance state of the robot.
- control instruction may be set in the robot in advance, and is not limited to being obtained from the remote terminal 31.
- the main control terminal 301 obtains the current motion parameters from the sensor 303, where the motion parameters include one or more of the current speed, acceleration, position, and attitude of the robot.
- the main control terminal 301 compares the current motion parameter with a first threshold to obtain the current environment of the robot, where the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
- the main control terminal 301 obtains the current maneuverability parameters, wherein the maneuverability parameters include one or more of the current speed and torque of the motor.
- the main control terminal 301 compares the current maneuverability parameter with a second threshold value to obtain the current maneuverability state of the robot, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
- the main control terminal 301 obtains a current control performance parameter, where the control performance parameter includes one or more of an adjustment time and an error range.
- the main control terminal 301 compares the current control performance parameter with a third threshold to obtain the current control performance state of the robot, wherein the third threshold is a maneuverability parameter corresponding to the control instruction under a standard environment.
- the current environment of the robot is a standard environment
- the current state of the robot's maneuverability is good
- the current state of the robot's control performance is good
- the current maneuver of the robot At least one of a performance state or a current control performance state of the robot, and adjusting the control instruction includes maintaining the control instruction unchanged.
- the current status of the robot Adjusting the control instruction includes at least one of a maneuverability state or a current control performance state of the robot, including: reducing a current acceleration and / or speed.
- reducing the current acceleration and / or speed includes reducing the current acceleration and speed to alleviate the vibration of the robot on the bumpy road.
- the reducing the current acceleration and / or speed includes reducing the current acceleration so that the robot speed matches the wheel speed.
- reducing the current acceleration and / or speed includes reducing the current acceleration and / or speed so that the robot can run slowly and steadily.
- the execution end 302 is configured to adjust the movement of the robot according to the adjusted control instruction.
- the execution end 302 is further configured to send a maneuverability parameter to the main control end 301, where the maneuverability parameter includes one or more of a current rotation speed and a torque of the motor.
- the sensor 303 is configured to send a motion parameter to the main control end 301, where the motion parameter includes one or more of a robot's current speed, acceleration, position, and attitude.
- the sensor 303 may include one or more of an accelerometer, a speedometer, a code disc, a vision sensor, a lidar, and an ultrasonic sensor.
- the sensor 303 may be installed inside the robot or outside the robot.
- a sensor 303 may be installed in the warehouse, and the sensor 303 sends the motion parameters of the robot to the main control terminal 301 through wireless transmission.
- high-precision sensors can provide more accurate motion parameters for mobile robots.
- sensors such as high-precision vision sensors have higher weight and larger volume. Installing sensor 303 outside the robot is conducive to reducing movement. The weight of the robot itself improves the portability of the mobile robot.
- the main control terminal 301 includes a maneuverability regulator 401 and a controller 402.
- the maneuverability adjuster 401 is specifically configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current maneuverability status of the robot according to the control instruction and the current execution state of the control instruction, Or at least one of the current control performance state of the robot, and the control instruction is adjusted according to at least one of the current environment of the robot, the current maneuverability state of the robot, or the current control performance state of the robot.
- the controller 402 is specifically configured to obtain an adjusted control instruction and a feedback amount, the feedback amount including one or more of a motor speed, a motor torque, a robot speed, a robot acceleration, a robot position, and a robot attitude;
- the controller 402 is further configured to determine an input of the execution end 302 according to the adjusted control instruction and the feedback amount, so that the execution end 302 further adjusts the movement of the robot.
- the main control terminal 301 is further configured to send at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot to the remote control terminal 31.
- the remote end 31 further includes a display area.
- the display area 501 is used to display at least one of a current environment of the robot, a current state of the robot's performance, or a current state of the control performance of the robot. It should be noted that other methods, such as voice, may be used as needed, and are not limited to the display through the display area 501.
- the main control terminal 301 sends at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot to the remote control terminal 31 to facilitate the remote control terminal to know the current state of the robot in time. While the mobile robot 30 adaptively adjusts its own motion, the remote control end 31 can adjust the robot's motion according to the information sent.
- the mobile robot control system and mobile robot provided by the embodiments of the present invention determine at least one of the current environment of the robot, the current mobility performance status of the robot, or the current control performance status of the robot by determining the current execution status of the control instruction.
- the control instruction is adjusted to adjust the movement of the robot in real time. It can be seen that the control system and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, and exhibit stable maneuverability, thereby improving the control efficiency of the mobile robot and safety.
- the remote terminal sends control instructions, the control instructions are a speed of 1m / s and an acceleration of 1m / s 2 ;
- the master control terminal obtains control instructions
- the main control terminal acquires the motion parameters collected by the sensors, that is, the actual motion speed is 0.8m / s and the acceleration is 0.5m / s 2 ;
- the main control end obtains the maneuverability parameters from the execution end. Specifically, the actual speed and torque of each wheel are obtained through the ESC installed on each wheel, that is, the average speed of the motor is 250 rpm (revolutions per minute), and the peak torque is 150 mNm. (Millinewtons);
- the master control terminal obtains control performance parameters, that is, the adjustment time is 1.2s, and the error range is 0.2m / s;
- the main control end compares the motion parameters, maneuverability parameters and control performance parameters with the motion parameters, maneuverability parameters and control performance parameters on the standard road surface, and obtains that the current environment of the robot is a smooth road, and the current maneuverability of the robot and the current control of the robot Poor performance
- the main control terminal adjusts the control instruction, and the adjusted control instruction is an acceleration of 0.5 m / s 2 ;
- the execution end adjusts the movement of the robot according to the adjusted control instruction.
- the remote end generates control instructions and sends them to the mobile robot, where the control instructions are a speed of 3m / s and an acceleration of 2m / s 2 ;
- the maneuverability regulator in the master control terminal obtains control instructions
- the maneuverability regulator obtains the movement parameters collected by the sensor, that is, the actual movement speed is 2.5m / s and the acceleration is 0.5m / s 2 ;
- the maneuverability regulator obtains maneuverability parameters from the execution end, that is, the average speed of the motor is 1000 rpm, and the peak torque is 350 mNm;
- the maneuverability regulator obtains the control performance parameters, that is, the adjustment time is 2.5s, and the error range is 0.5m / s;
- the maneuverability controller compares the movement parameters, maneuverability parameters, and control performance parameters with the movement parameters, maneuverability parameters, and control performance parameters on a standard road surface, and obtains that the current environment of the robot is a smooth road. Poor current control performance;
- the maneuverability adjuster adjusts the control instruction, and the adjusted control instruction is an acceleration of 1 m / s 2 ;
- the mobile performance adjuster sends the adjusted control instructions to the controller
- the controller obtains the adjusted control instruction
- the controller obtains the feedback amount, that is, the average speed of the motor is 1200rpm, the peak torque is 400mNm, the robot speed is 3m / s, and the acceleration is 0.8m / s 2 ;
- the controller determines the input of the execution end according to the adjusted control instruction and the feedback amount, so that the execution end further adjusts the movement of the robot.
- the disclosed apparatus and method may be implemented in other manners.
- the device embodiments described above are only schematic.
- the division of the unit is only a logical function division.
- multiple units or components may be combined or Can be integrated into another system, or some features can be ignored or not implemented.
- the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, devices or units, which may be electrical, mechanical or other forms.
- the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, may be located in one place, or may be distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the objective of the solution of this embodiment.
- each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist separately physically, or two or more units may be integrated into one unit.
- the above integrated unit may be implemented in the form of hardware, or in the form of hardware plus software functional units.
- the above integrated unit implemented in the form of a software functional unit may be stored in a computer-readable storage medium.
- the software functional unit is stored in a storage medium and includes several instructions for causing a computer device (which may be a personal computer, a server, or a network device) or a processor to execute the methods described in the embodiments of the present invention. Some steps.
- the aforementioned storage media include: U disks, mobile hard disks, read-only memory (ROM), random access memory (RAM), magnetic disks or compact discs, and other media that can store program codes .
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
Disclosed by the embodiments of the present invention are a mobile robot control method, the method comprising: acquiring a control instruction sent by a remote terminal (S201); determining the current execution state of the control instruction (S202); determining at least one item among the current environment of a robot, the current maneuverability state of the robot or the current control performance state of the robot according to the control instruction and the current execution state of the control instruction (S203); adjusting the control instruction according to the at least one of the current environment of the robot, the current maneuverability state of the robot or the current control performance state of the robot, so that an execution terminal adjusts the movement of the robot according to the adjusted control instruction (S204). Also disclosed by the embodiments of the present invention are a mobile robot control system and the mobile robot.
Description
本发明实施例涉及控制领域,尤其涉及一种移动机器人的控制方法、系统及移动机器人。Embodiments of the present invention relate to the field of control, and in particular, to a control method and system for a mobile robot, and a mobile robot.
移动机器人以同样的控制指令进入到不同的环境时,会表现出不同的机动性能。以轮式机器人为例,当其运动到光滑路面时,若维持原较大速度,则容易发生打滑或侧翻,机器人的控制效率低,安全性差。When a mobile robot enters different environments with the same control instructions, it will show different maneuverability. Taking a wheeled robot as an example, when it moves to a smooth road, if it maintains the original large speed, it will easily slip or roll over, the control efficiency of the robot is low, and the safety is poor.
现有技术中,通常采用人工调整控制指令的方法,以保持移动机器人在进入不同环境时表现出稳定的机动性能。然而当环境复杂或远距离遥控时,操作员无法及时感知环境的变化,并将控制指令调整至适应当前环境,容易导致设备损坏,出现安全事故。In the prior art, a method of manually adjusting control instructions is generally adopted to maintain a mobile robot showing stable maneuverability when entering different environments. However, when the environment is complex or remotely controlled, the operator cannot sense the change of the environment in time, and adjust the control instructions to adapt to the current environment, which easily leads to equipment damage and safety accidents.
发明内容Summary of the Invention
鉴于以上内容,有必要提供一种移动机器人的控制方法、系统及移动机器人,可以使移动机器人在进入到不同的环境时,表现出稳定的机动性能,提高移动机器人的控制效率和安全性。In view of the above, it is necessary to provide a mobile robot control method, system, and mobile robot, which can make the mobile robot exhibit stable maneuverability when entering different environments, and improve the control efficiency and safety of the mobile robot.
本发明实施例的第一方面是提供一种移动机器人的控制方法,所述方法包括:A first aspect of an embodiment of the present invention is to provide a method for controlling a mobile robot, the method including:
获取遥控端发送的控制指令;Obtain the control instructions sent by the remote end;
确定所述控制指令的当前执行状态;Determining a current execution state of the control instruction;
根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项;Determining, according to the control instruction and the current execution state of the control instruction, at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot;
根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,以使得执行端根据调节后的控制指令调整机器人的移动。Adjusting the control instruction according to at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot, so that the execution end adjusts the movement of the robot according to the adjusted control instruction .
本发明实施例的第二方面是提供一种移动机器人,所述移动机器人包括:主控端、执行端;A second aspect of the embodiments of the present invention is to provide a mobile robot, the mobile robot includes: a main control terminal and an execution terminal;
所述主控端,用于获取控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令;The main control terminal is configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current state of the robot's mobility performance according to the control instruction and the current execution state of the control instruction, or Adjusting at least one of a current control performance state of the robot according to at least one of a current environment of the robot, a current maneuverability state of the robot, or a current control performance state of the robot;
所述执行端,用于根据调节后的控制指令调整机器人的移动。The execution end is configured to adjust the movement of the robot according to the adjusted control instruction.
本发明实施例的第三方面是提供一种移动机器人控制系统,所述控制系统包括遥控端和移动机器人,所述遥控端用于生成控制指令并发送给移动机器人。A third aspect of the embodiments of the present invention is to provide a mobile robot control system. The control system includes a remote control terminal and a mobile robot, and the remote control terminal is configured to generate a control instruction and send the control instruction to the mobile robot.
所述移动机器人包括:主控端、执行端;The mobile robot includes: a main control terminal and an execution terminal;
所述主控端,用于获取控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令;The main control terminal is configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current state of the robot's mobility performance according to the control instruction and the current execution state of the control instruction, or Adjusting at least one of a current control performance state of the robot according to at least one of a current environment of the robot, a current maneuverability state of the robot, or a current control performance state of the robot;
所述执行端,用于根据调节后的控制指令调整机器人的移动。The execution end is configured to adjust the movement of the robot according to the adjusted control instruction.
本发明实施例提供的移动机器人的控制方法、控制系统及移动机器人,是通过确定控制指令的当前执行状态,判断机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,以调节所述控制指令,从而实时调整机器人的移动。由此可见,本发明实施例提供的移动机器人的控制方法、控制系统及移动机器人,使移动机器人在进入到不同环境时,能够自适应地调整自身的运动,表现出稳定的机动性能,从而提高移动机器人的控制效率和安全性。The mobile robot control method, control system and mobile robot provided by the embodiments of the present invention determine at least one of the current environment of the robot, the current mobility performance status of the robot, or the current control performance status of the robot by determining the current execution status of the control instruction. Item to adjust the control instruction to adjust the movement of the robot in real time. It can be seen that the mobile robot control method, control system, and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, thereby exhibiting stable maneuverability, thereby improving Control efficiency and safety of mobile robots.
为了更清楚地说明本发明实施例中的技术方案,下面将对所需要使用的附图作一简单地介绍,显而易见地,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions in the embodiments of the present invention more clearly, the following drawings will be briefly introduced. Obviously, it will be apparent to those skilled in the art without any creative labor. You can also get other drawings based on these drawings.
图1为现有技术提供的一种不同路面上轮式移动机器人运动示意图。FIG. 1 is a motion diagram of a wheeled mobile robot on different roads provided in the prior art.
图2为本发明实施例提供的一种移动机器人控制方法流程图。FIG. 2 is a flowchart of a mobile robot control method according to an embodiment of the present invention.
图3为本发明实施例提供的一种移动机器人控制系统示意图。FIG. 3 is a schematic diagram of a mobile robot control system according to an embodiment of the present invention.
图4为本发明实施例提供的一种主控端示意图。FIG. 4 is a schematic diagram of a master terminal according to an embodiment of the present invention.
图5为本发明实施例提供的一种遥控端示意图。FIG. 5 is a schematic diagram of a remote control terminal according to an embodiment of the present invention.
下面将结合附图,对本发明实施例中的技术方案进行清楚地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly described below with reference to the accompanying drawings. Obviously, the described embodiments are only a part of the embodiments of the present invention, but not all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by a person of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. The terminology used herein in the description of the invention is for the purpose of describing particular embodiments only and is not intended to limit the invention. The term "and / or" as used herein includes any and all combinations of one or more of the associated listed items.
本发明实施例提供的移动机器人的控制方法及控制系统应用于移动机器人。示例的,可用于轮式移动机器人,请参见图1,图1为现有技术提供的一种不同路面上轮式移动机器人运动示意图,包括遥控端101和移动机器人端102。在机器人的运动过程中,遥控端101发送控制指令给移动机器人端102,移动机器人端102根据控制指令控制轮式移动机器人的移动。当机器人从标准环境运动到非标准环境时,操作员需要人工调整控制指令。然而当环境复杂或远距离遥控时,操作员无法及时感知环境的变化,并将运动参数调整至适应当前环境,容易导致设备损坏,出现安全事故。由此可见,复杂环境或远距离遥控下,移动机器人机动性能自适应尤为重要。The control method and control system for a mobile robot provided by the embodiments of the present invention are applied to a mobile robot. For example, it can be used for a wheeled mobile robot. Please refer to FIG. 1. FIG. 1 is a schematic diagram of a wheeled mobile robot on different roads provided in the prior art, including a remote control terminal 101 and a mobile robot terminal 102. During the movement of the robot, the remote control terminal 101 sends a control instruction to the mobile robot terminal 102, and the mobile robot terminal 102 controls the movement of the wheeled mobile robot according to the control instruction. When the robot moves from a standard environment to a non-standard environment, the operator needs to manually adjust the control instructions. However, when the environment is complex or remotely controlled, the operator cannot sense the changes in the environment in time and adjust the motion parameters to the current environment, which easily leads to equipment damage and safety accidents. It can be seen that in complex environments or remote remote control, self-adaption of mobile robot's mobility is particularly important.
本发明实施例提供的移动机器人的控制方法、控制系统及移动机器人,使移动机器人在进入到不同环境时,能够自适应地调整自身的运动,表现出稳定的机动性能,从而提高移动机器人的控制效率和安全性。The mobile robot control method, control system and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, and exhibit stable maneuverability, thereby improving the control of the mobile robot. Efficiency and safety.
下面结合附图,对本发明的一些实施方式作详细说明。在不冲突的情 况下,下述的实施例及实施例中的特征可以相互组合。Hereinafter, some embodiments of the present invention will be described in detail with reference to the drawings. In the case of no conflict, the following embodiments and features in the embodiments can be combined with each other.
图2为本发明实施例提供的移动机器人的控制方法的流程图,本实施例所述的移动机器人具体可以是轮式移动机器人,无人飞行器、无人船等。FIG. 2 is a flowchart of a method for controlling a mobile robot according to an embodiment of the present invention. The mobile robot described in this embodiment may specifically be a wheeled mobile robot, an unmanned aerial vehicle, or an unmanned ship.
本实施例中的方法,可以包括:The method in this embodiment may include:
步骤S201,获取遥控端发送的控制指令。Step S201: Obtain a control instruction sent by the remote terminal.
可选的,本实施例所述控制指令包括速度指令、加速度指令、位置指令、姿态指令中的一种或多种。Optionally, the control instruction in this embodiment includes one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
步骤S202,确定所述控制指令的当前执行状态。Step S202: Determine a current execution state of the control instruction.
可选的,所述确定所述控制指令的当前执行状态包括:获取当前运动参数,其中,所述运动参数包括机器人当前速度,加速度,位置,姿态中的一种或多种。Optionally, determining the current execution state of the control instruction includes: acquiring current motion parameters, wherein the motion parameters include one or more of a current speed, acceleration, position, and attitude of the robot.
可选的,所述确定所述控制指令的当前执行状态包括:获取当前机动性能参数,其中,所述机动性能参数包括电机当前转速,扭矩中的一种或多种。Optionally, determining the current execution state of the control instruction includes: obtaining current maneuverability parameters, wherein the maneuverability parameters include one or more of a current rotation speed and a torque of the motor.
可选的,所述确定所述控制指令的当前执行状态包括:获取当前控制性能参数,其中,所述控制性能参数包括调节时间,误差范围中的一种或多种。所述调节时间为机器人实际输出稳定在预设范围内的时间,误差范围为机器人的实际输出相对于控制指令目标输出的误差。示例的,若控制指令为速度指令5m/s,预设范围是5m/s±10%,则调节时间是实际速度从原始速度稳定到4.5m/s-5.5m/s的时间。Optionally, determining the current execution status of the control instruction includes: obtaining a current control performance parameter, wherein the control performance parameter includes one or more of an adjustment time and an error range. The adjustment time is the time when the actual output of the robot stabilizes within a preset range, and the error range is the error of the actual output of the robot relative to the target output of the control instruction. For example, if the control instruction is a speed instruction of 5m / s and the preset range is 5m / s ± 10%, the adjustment time is the time when the actual speed stabilizes from the original speed to 4.5m / s-5.5m / s.
步骤S203,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项。In step S203, at least one of the environment in which the robot is currently located, the current state of the robotic performance of the robot, or the current state of the control performance of the robot is determined according to the control instruction and the current execution state of the control instruction.
可选的,将所述当前运动参数与第一阈值对比得到机器人当前所处环境,其中,所述第一阈值为所述控制指令在标准环境下对应的运动参数。Optionally, the current motion parameter is compared with a first threshold to obtain the current environment of the robot, wherein the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
可选的,将所述当前机动性能参数与第二阈值对比得到机器人当前机动性能状态,其中,所述第二阈值为所述控制指令在标准环境下对应的机动性能参数。Optionally, the current maneuverability parameter of the robot is obtained by comparing the current maneuverability parameter with a second threshold, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
可选的,将所述当前控制性能参数与第三阈值对比得到机器人当前控制性能状态,其中,所述第三阈值为所述控制指令在标准环境下对应的控 制性能参数。Optionally, the current control performance parameter is compared with a third threshold value to obtain the current control performance state of the robot, wherein the third threshold value is a control performance parameter corresponding to the control instruction under a standard environment.
可选的,所述控制指令在标准环境下对应的运动参数,机动性能参数,控制性能参数是通过标定试验或仿真计算得到的。具体的,若移动机器人为轮式移动机器人,仿真可通过对其进行动力学和运动学建模,用路面摩擦系数等参数描述不同的环境状态,从而推导出控制指令与不同环境下运动参数,机动性能参数,控制性能参数的映射关系。Optionally, the corresponding motion parameters, maneuverability parameters, and control performance parameters of the control instruction in a standard environment are obtained through calibration experiments or simulation calculations. Specifically, if the mobile robot is a wheeled mobile robot, the simulation can model the dynamic environment and kinematics, describe different environmental states with parameters such as road friction coefficient, and derive control instructions and motion parameters in different environments. Maneuverability parameters, the mapping relationship between control performance parameters.
步骤S204,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,以使得执行端根据调节后的控制指令调整机器人的移动。Step S204, adjusting the control instruction according to at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot, so that the execution end adjusts according to the adjusted control instruction The movement of the robot.
可选的,若所述机器人当前所处环境为标准环境,所述机器人当前机动性能状态良好,所述机器人当前控制性能状态良好,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:维持所述控制指令不变。Optionally, if the current environment of the robot is a standard environment, the current state of the robot's maneuverability is good, and the current state of the robot's control performance is good, then, according to the current environment of the robot, the current maneuver of the robot At least one of a performance state or a current control performance state of the robot, and adjusting the control instruction includes maintaining the control instruction unchanged.
可选的,若所述机器人当前所处环境为非标准环境,所述机器人当前机动性能状态不良,所述机器人当前控制性能状态不良,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:降低当前加速度和/或速度。Optionally, if the current environment of the robot is a non-standard environment, the current state of the mobile performance of the robot is poor, and the current state of the control performance of the robot is poor, then according to the current environment of the robot, the current status of the robot Adjusting the control instruction includes at least one of a maneuverability state or a current control performance state of the robot, including: reducing a current acceleration and / or speed.
可选的,所述非标准环境包括颠簸路面,光滑路面,泥泞路面。Optionally, the non-standard environment includes bumpy roads, smooth roads, and muddy roads.
可选的,以轮式移动机器人为例,当机器人电机转速高而扭矩小,即电机转速与扭矩比偏大,姿态调节时间偏长,Z轴加速度出现高幅度震荡,轮子频繁悬空时,可判断机器人当前所处环境为颠簸路面;当电机转速高而扭矩小,即电机转速与扭矩比偏大,速度调节时间和姿态调节时间偏长,而Z轴加速度变化平缓,机器人在起步和刹车阶段频繁打滑时,可判断机器人当前所处环境为光滑路面;当电机转速低而扭矩大,即电机转速与扭矩比偏小,速度调节时间和姿态调节时间长,轮子受到较大的阻力时,可判断机器人当前所处环境为泥泞路面。Optionally, taking a wheeled mobile robot as an example, when the motor speed of the robot is high and the torque is small, that is, the motor speed to torque ratio is too large, the attitude adjustment time is too long, the Z-axis acceleration appears high amplitude vibration, and the wheel is frequently suspended, Determine the current environment of the robot as a bumpy road; when the motor speed is high and the torque is small, that is, the motor speed to torque ratio is too large, the speed adjustment time and attitude adjustment time are longer, and the Z-axis acceleration changes gently, and the robot is in the starting and braking stages. When the skid is frequent, it can be judged that the current environment of the robot is a smooth road; when the motor speed is low and the torque is large, that is, the motor speed to torque ratio is small, the speed adjustment time and attitude adjustment time are long, and the wheel is subject to greater resistance, the Determine the current environment of the robot as a muddy road.
可选的,若所述非标准环境为颠簸路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以缓解机器人在颠簸路面的振动。若所述非标准环境为光滑路面,所述降低当前加速度和/或速度,包括:降低 当前加速度,以使机器人速度与车轮转速匹配。若所述非标准环境为泥泞路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以使得机器人可缓慢稳定行驶。Optionally, if the non-standard environment is a bumpy road, reducing the current acceleration and / or speed includes reducing the current acceleration and speed to alleviate the vibration of the robot on the bumpy road. If the non-standard environment is a smooth road, reducing the current acceleration and / or speed includes reducing the current acceleration so that the robot speed matches the wheel speed. If the non-standard environment is a muddy road, reducing the current acceleration and / or speed includes reducing the current acceleration and / or speed so that the robot can run slowly and steadily.
本发明实施例中,将机器人当前所处环境划分为标准环境和非标准环境,非标准环境包括颠簸路面、光滑路面、泥泞路面。可以理解,根据移动机器人的类型和实际需要可将机器人当前所处环境扩展为更多场景,并按照不同场景划分不同等级,并且不限于文字形式,可以根据实际需要进行设置,例如,也可以通过数字或者其他形式进行表示。示例的,当通过数字表示时,就颠簸这一场景可划分1到10级的不同等级,数字越大,表示颠簸程度越严重。同理,也可以将光滑、泥泞等其他场景划分为更多等级,更详尽的描述机器人当前所处的环境。In the embodiment of the present invention, the current environment of the robot is divided into a standard environment and a non-standard environment. The non-standard environment includes bumpy roads, smooth roads, and muddy roads. It can be understood that the current environment of the robot can be expanded into more scenes according to the type and actual needs of the mobile robot, and divided into different levels according to different scenes, and is not limited to the text form, and can be set according to actual needs. For example, you can also use Expressed in numbers or other forms. For example, when represented by numbers, the scene of bumps can be divided into different levels from 1 to 10. The larger the number, the more severe the bump. Similarly, other scenes such as smooth and muddy can also be divided into more levels to describe the environment in which the robot is currently in more detail.
本发明实施例中,只是以不良为例对机动性能状态、控制性能状态进行说明,机器人当前机动性能状态和机器人当前控制性能状态还可以根据需要扩展更多等级。可以理解的,调节后的控制指令的具体内容不限于实施例中所述的降低加速度和/或速度,可以根据移动机器人的类型,控制指令的内容及实际应用场景扩展为更多类型。In the embodiment of the present invention, the maneuverability state and the control performance state are described only by taking the bad as an example. The current maneuverability state of the robot and the current state of the control performance of the robot can be expanded by more levels as needed. It can be understood that the specific content of the adjusted control instruction is not limited to reducing the acceleration and / or speed described in the embodiment, and the content of the control instruction and the actual application scenario can be expanded into more types according to the type of the mobile robot.
在其他实施例中,所述移动机器人控制方法还包括:In other embodiments, the mobile robot control method further includes:
获取反馈量,所述反馈量包括电机转速、电机扭矩、机器人速度、机器人加速度、机器人位置、机器人姿态中的一种或多种;Obtaining a feedback amount, which includes one or more of a motor speed, a motor torque, a robot speed, a robot acceleration, a robot position, and a robot posture;
根据所述反馈量和所述调节后的控制指令进一步调整机器人的移动。The movement of the robot is further adjusted according to the feedback amount and the adjusted control instruction.
在其他实施例中,所述移动机器人控制方法还包括,将所述机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端。将机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端,可以使遥控端及时了解机器人当前状态。在机器人自适应地调整自身运动的同时,遥控端可以根据发送的信息对机器人的运动进行调整。In other embodiments, the mobile robot control method further includes sending at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot to the remote control end. Sending at least one of the current environment of the robot, the current mobile performance state of the robot, or the current control performance state of the robot to the remote control terminal can make the remote control terminal know the current state of the robot in time. While the robot adaptively adjusts its own motion, the remote control can adjust the robot's motion based on the information sent.
本发明实施例提供的移动机器人的控制方法,是通过确定控制指令的当前执行状态,判断机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,以调节所述控制指令,从而实时调整机器人的移动。由此可见,本发明实施例提供的移动机器人的控制方法, 使移动机器人在进入到不同环境时,能够自适应地调整自身的运动,表现出稳定的机动性能,从而提高移动机器人的控制效率和安全性。The method for controlling a mobile robot provided by an embodiment of the present invention is to determine at least one of the current environment of the robot, the current state of the mobile performance of the robot, or the current state of the control performance of the robot by determining the current execution state of the control instruction to adjust the state. Control instructions to adjust robot movement in real time. It can be seen that the mobile robot control method provided by the embodiment of the present invention enables the mobile robot to adaptively adjust its own motion when it enters different environments and exhibits stable maneuverability, thereby improving the control efficiency of the mobile robot and safety.
图3为本发明实施例提供的一种移动机器人控制系统示意图。可选的,本实施例所述的移动机器人具体可以是轮式移动机器人,无人飞行器、无人船等。请参见图3,所述控制系统包括移动机器人30和遥控端31,移动机器人30包括主控端301、执行端302、传感器303。FIG. 3 is a schematic diagram of a mobile robot control system according to an embodiment of the present invention. Optionally, the mobile robot described in this embodiment may be a wheeled mobile robot, an unmanned aerial vehicle, or an unmanned ship. Referring to FIG. 3, the control system includes a mobile robot 30 and a remote control terminal 31. The mobile robot 30 includes a main control terminal 301, an execution terminal 302, and a sensor 303.
遥控端31用于生成控制指令并发送给移动机器人30。The remote terminal 31 is used to generate a control instruction and send it to the mobile robot 30.
可选的,所述控制指令包括速度指令、加速度指令、位置指令、姿态指令中的一种或多种。Optionally, the control instruction includes one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
主控端301,用于获取遥控端31发送的控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令。The main control terminal 301 is configured to obtain a control instruction sent by the remote control terminal 31, determine the current execution status of the control instruction, and determine the current environment of the robot and the current maneuver of the robot according to the control instruction and the current execution status of the control instruction. At least one of a performance state or a current control performance state of the robot, and the control instruction is adjusted according to at least one of an environment in which the robot is currently located, a current maneuverability state of the robot, or a current control performance state of the robot.
在其他的实施例中,所述控制指令也可以预先设定在机器人内部,并不限于从遥控端31获取。In other embodiments, the control instruction may be set in the robot in advance, and is not limited to being obtained from the remote terminal 31.
可选的,主控端301从传感器303获取当前运动参数,其中,所述运动参数包括机器人当前速度,加速度,位置,姿态中的一种或多种。Optionally, the main control terminal 301 obtains the current motion parameters from the sensor 303, where the motion parameters include one or more of the current speed, acceleration, position, and attitude of the robot.
可选的,主控端301将所述当前运动参数与第一阈值对比得到机器人当前所处环境,其中,所述第一阈值为所述控制指令在标准环境下对应的运动参数。Optionally, the main control terminal 301 compares the current motion parameter with a first threshold to obtain the current environment of the robot, where the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
可选的,主控端301获取当前机动性能参数,其中,所述机动性能参数包括电机当前转速,扭矩中的一种或多种。Optionally, the main control terminal 301 obtains the current maneuverability parameters, wherein the maneuverability parameters include one or more of the current speed and torque of the motor.
可选的,主控端301将所述当前机动性能参数与第二阈值对比得到机器人当前机动性能状态,其中,所述第二阈值为所述控制指令在标准环境下对应的机动性能参数。Optionally, the main control terminal 301 compares the current maneuverability parameter with a second threshold value to obtain the current maneuverability state of the robot, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
可选的,主控端301获取当前控制性能参数,其中,所述控制性能参数包括调节时间,误差范围中的一种或多种。Optionally, the main control terminal 301 obtains a current control performance parameter, where the control performance parameter includes one or more of an adjustment time and an error range.
可选的,主控端301将所述当前控制性能参数与第三阈值对比得到机器人当前控制性能状态,其中,所述第三阈值为所述控制指令在标准环境 下对应的机动性能参数。Optionally, the main control terminal 301 compares the current control performance parameter with a third threshold to obtain the current control performance state of the robot, wherein the third threshold is a maneuverability parameter corresponding to the control instruction under a standard environment.
可选的,若所述机器人当前所处环境为标准环境,所述机器人当前机动性能状态良好,所述机器人当前控制性能状态良好,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:维持所述控制指令不变。Optionally, if the current environment of the robot is a standard environment, the current state of the robot's maneuverability is good, and the current state of the robot's control performance is good, then, according to the current environment of the robot, the current maneuver of the robot At least one of a performance state or a current control performance state of the robot, and adjusting the control instruction includes maintaining the control instruction unchanged.
可选的,若所述机器人当前所处环境为非标准环境,所述机器人当前机动性能状态不良,所述机器人当前控制性能状态不良,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:降低当前加速度和/或速度。Optionally, if the current environment of the robot is a non-standard environment, the current state of the mobile performance of the robot is poor, and the current state of the control performance of the robot is poor, then according to the current environment of the robot, the current status of the robot Adjusting the control instruction includes at least one of a maneuverability state or a current control performance state of the robot, including: reducing a current acceleration and / or speed.
可选的,若所述非标准环境为颠簸路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以缓解机器人在颠簸路面的振动。若所述非标准环境为光滑路面,所述降低当前加速度和/或速度,包括:降低当前加速度,以使机器人速度与车轮转速匹配。若所述非标准环境为泥泞路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以使得机器人可缓慢稳定行驶。Optionally, if the non-standard environment is a bumpy road, reducing the current acceleration and / or speed includes reducing the current acceleration and speed to alleviate the vibration of the robot on the bumpy road. If the non-standard environment is a smooth road, the reducing the current acceleration and / or speed includes reducing the current acceleration so that the robot speed matches the wheel speed. If the non-standard environment is a muddy road, reducing the current acceleration and / or speed includes reducing the current acceleration and / or speed so that the robot can run slowly and steadily.
执行端302,用于根据调节后的控制指令调整机器人的移动。The execution end 302 is configured to adjust the movement of the robot according to the adjusted control instruction.
可选的,执行端302还用于将机动性能参数发送给主控端301,所述机动性能参数包括电机当前转速,扭矩中的一种或多种。Optionally, the execution end 302 is further configured to send a maneuverability parameter to the main control end 301, where the maneuverability parameter includes one or more of a current rotation speed and a torque of the motor.
传感器303,用于将运动参数发送给主控端301,所述运动参数包括机器人当前速度,加速度,位置,姿态中的一种或多种。The sensor 303 is configured to send a motion parameter to the main control end 301, where the motion parameter includes one or more of a robot's current speed, acceleration, position, and attitude.
可以理解的,所述传感器303可以包括加速度计、速度计、码盘、视觉传感器、激光雷达、超声波传感器中的一种或多种。传感器303可以安装在机器人内部也可以安装在机器人外部。示例的,对于应用于仓库运输的移动机器人,可以将传感器303安装在仓库中,传感器303通过无线传输的方式,将机器人的运动参数发送给主控端301。可以理解的,高精度传感器可以为移动机器人提供更精确的运动参数,然而,如高精度视觉传感器这类的传感器,其重量较高、体积较大,将传感器303安装在机器人外部有利于减轻移动机器人本身的重量,提高移动机器人的便携性。It can be understood that the sensor 303 may include one or more of an accelerometer, a speedometer, a code disc, a vision sensor, a lidar, and an ultrasonic sensor. The sensor 303 may be installed inside the robot or outside the robot. For example, for a mobile robot applied to warehouse transportation, a sensor 303 may be installed in the warehouse, and the sensor 303 sends the motion parameters of the robot to the main control terminal 301 through wireless transmission. It can be understood that high-precision sensors can provide more accurate motion parameters for mobile robots. However, sensors such as high-precision vision sensors have higher weight and larger volume. Installing sensor 303 outside the robot is conducive to reducing movement. The weight of the robot itself improves the portability of the mobile robot.
请结合图3和图4,在其他实施例中,所述主控端301包括机动性能 调节器401和控制器402。With reference to FIG. 3 and FIG. 4, in other embodiments, the main control terminal 301 includes a maneuverability regulator 401 and a controller 402.
机动性能调节器401,具体用于获取控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令。The maneuverability adjuster 401 is specifically configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current maneuverability status of the robot according to the control instruction and the current execution state of the control instruction, Or at least one of the current control performance state of the robot, and the control instruction is adjusted according to at least one of the current environment of the robot, the current maneuverability state of the robot, or the current control performance state of the robot.
控制器402,具体用于获取调节后的控制指令和反馈量,所述反馈量包括的电机转速、电机扭矩、机器人速度、机器人加速度、机器人位置、机器人姿态中的一种或多种;The controller 402 is specifically configured to obtain an adjusted control instruction and a feedback amount, the feedback amount including one or more of a motor speed, a motor torque, a robot speed, a robot acceleration, a robot position, and a robot attitude;
控制器402,还用于根据所述调节后的控制指令和所述反馈量确定执行端302的输入,以使得执行端302进一步调整机器人的移动。The controller 402 is further configured to determine an input of the execution end 302 according to the adjusted control instruction and the feedback amount, so that the execution end 302 further adjusts the movement of the robot.
在其他实施例中,主控端301还用于将机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端31。可选的,遥控端31还包括显示区,结合图5,所述显示区501用于显示机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项。需要说明的是,可根据需要采用语音等其他方式,并不限于通过显示区501的显示。In other embodiments, the main control terminal 301 is further configured to send at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot to the remote control terminal 31. Optionally, the remote end 31 further includes a display area. In conjunction with FIG. 5, the display area 501 is used to display at least one of a current environment of the robot, a current state of the robot's performance, or a current state of the control performance of the robot. It should be noted that other methods, such as voice, may be used as needed, and are not limited to the display through the display area 501.
可以理解的,主控端301将机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端31有利于遥控端及时了解机器人当前状态。在移动机器人30自适应地调整自身运动的同时,遥控端31可以根据发送的信息对机器人的运动进行调整。It can be understood that the main control terminal 301 sends at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot to the remote control terminal 31 to facilitate the remote control terminal to know the current state of the robot in time. While the mobile robot 30 adaptively adjusts its own motion, the remote control end 31 can adjust the robot's motion according to the information sent.
本发明实施例提供的移动机器人的控制系统及移动机器人,是通过确定控制指令的当前执行状态,判断机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,以调节所述控制指令,从而实时调整机器人的移动。由此可见,本发明实施例提供的控制系统及移动机器人,使移动机器人在进入到不同环境时,能够自适应地调整自身的运动,表现出稳定的机动性能,从而提高移动机器人的控制效率和安全性。The mobile robot control system and mobile robot provided by the embodiments of the present invention determine at least one of the current environment of the robot, the current mobility performance status of the robot, or the current control performance status of the robot by determining the current execution status of the control instruction. The control instruction is adjusted to adjust the movement of the robot in real time. It can be seen that the control system and mobile robot provided by the embodiments of the present invention enable the mobile robot to adaptively adjust its own motion when it enters different environments, and exhibit stable maneuverability, thereby improving the control efficiency of the mobile robot and safety.
接下来以轮式移动机器人运动到光滑路面的场景详细说明本发明一种实施例提供的移动机器人控制方法、控制系统及移动机器人。Next, a scene in which a wheeled mobile robot moves to a smooth road will be described in detail for a mobile robot control method, a control system, and a mobile robot according to an embodiment of the present invention.
遥控端发送控制指令,所述控制指令为速度1m/s,加速度1m/s
2;
The remote terminal sends control instructions, the control instructions are a speed of 1m / s and an acceleration of 1m / s 2 ;
主控端获取控制指令;The master control terminal obtains control instructions;
主控端获取传感器采集到的运动参数,即实际运动速度为0.8m/s,加速度为0.5m/s
2;
The main control terminal acquires the motion parameters collected by the sensors, that is, the actual motion speed is 0.8m / s and the acceleration is 0.5m / s 2 ;
主控端从执行端获取机动性能参数,具体的,通过安装在每个轮子上的电调得到每个轮子的实际转速和扭矩,即电机转速均值为250rpm(转/分钟),扭矩峰值为150mNm(毫牛米);The main control end obtains the maneuverability parameters from the execution end. Specifically, the actual speed and torque of each wheel are obtained through the ESC installed on each wheel, that is, the average speed of the motor is 250 rpm (revolutions per minute), and the peak torque is 150 mNm. (Millinewtons);
主控端获取控制性能参数,即调节时间为1.2s,误差范围是0.2m/s;The master control terminal obtains control performance parameters, that is, the adjustment time is 1.2s, and the error range is 0.2m / s;
主控端将运动参数,机动性能参数和控制性能参数与标准路面上的运动参数,机动性能参数和控制性能参数对比,得到机器人当前所处环境为光滑路面,且机器人当前机动性能、机器人当前控制性能不良;The main control end compares the motion parameters, maneuverability parameters and control performance parameters with the motion parameters, maneuverability parameters and control performance parameters on the standard road surface, and obtains that the current environment of the robot is a smooth road, and the current maneuverability of the robot and the current control of the robot Poor performance
主控端调节所述控制指令,调节后的控制指令为加速度0.5m/s
2;
The main control terminal adjusts the control instruction, and the adjusted control instruction is an acceleration of 0.5 m / s 2 ;
执行端根据调节后的控制指令调整机器人的移动。The execution end adjusts the movement of the robot according to the adjusted control instruction.
接下来以轮式移动机器人运动到光滑路面的场景详细说明本发明的另一实施例提供的移动机器人控制方法、控制系统及移动机器人。Next, a scene in which a wheeled mobile robot moves to a smooth road will be described in detail for a mobile robot control method, a control system, and a mobile robot provided by another embodiment of the present invention.
遥控端生成控制指令并发送给移动机器人,所述控制指令为速度3m/s,加速度2m/s
2;
The remote end generates control instructions and sends them to the mobile robot, where the control instructions are a speed of 3m / s and an acceleration of 2m / s 2 ;
主控端中的机动性能调节器获取控制指令;The maneuverability regulator in the master control terminal obtains control instructions;
机动性能调节器获取传感器采集到的运动参数,即实际运动速度为2.5m/s,加速度为0.5m/s
2;
The maneuverability regulator obtains the movement parameters collected by the sensor, that is, the actual movement speed is 2.5m / s and the acceleration is 0.5m / s 2 ;
机动性能调节器从执行端获取机动性能参数,即电机转速均值为1000rpm,扭矩峰值为350mNm;The maneuverability regulator obtains maneuverability parameters from the execution end, that is, the average speed of the motor is 1000 rpm, and the peak torque is 350 mNm;
机动性能调节器获取控制性能参数,即调节时间为2.5s,误差范围是0.5m/s;The maneuverability regulator obtains the control performance parameters, that is, the adjustment time is 2.5s, and the error range is 0.5m / s;
机动性能调节器将运动参数,机动性能参数和控制性能参数与标准路面上的运动参数,机动性能参数和控制性能参数对比,得到当前机器人当前所处环境为光滑路面,且机器人当前机动性能、机器人当前控制性能不良;The maneuverability controller compares the movement parameters, maneuverability parameters, and control performance parameters with the movement parameters, maneuverability parameters, and control performance parameters on a standard road surface, and obtains that the current environment of the robot is a smooth road. Poor current control performance;
机动性能调节器调节所述控制指令,调节后的控制指令为加速度1m/s
2;
The maneuverability adjuster adjusts the control instruction, and the adjusted control instruction is an acceleration of 1 m / s 2 ;
机动性能调节器将调节后的控制指令发送给控制器;The mobile performance adjuster sends the adjusted control instructions to the controller;
控制器获取调节后的控制指令;The controller obtains the adjusted control instruction;
控制器获取反馈量,即电机转速均值为1200rpm,扭矩峰值为400mNm,机器人速度为3m/s,加速度为0.8m/s
2;
The controller obtains the feedback amount, that is, the average speed of the motor is 1200rpm, the peak torque is 400mNm, the robot speed is 3m / s, and the acceleration is 0.8m / s 2 ;
控制器根据调节后的控制指令和反馈量确定执行端的输入,以使得执行端进一步调整机器人的移动。The controller determines the input of the execution end according to the adjusted control instruction and the feedback amount, so that the execution end further adjusts the movement of the robot.
需要说明的是,上述步骤中涉及的具体参数和文字内容仅是为了说明本发明提供的实施方式,不应理解为对本发明的限制。It should be noted that the specific parameters and text content involved in the above steps are only for explaining the implementation manner provided by the present invention, and should not be construed as limiting the present invention.
在本发明所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided by the present invention, it should be understood that the disclosed apparatus and method may be implemented in other manners. For example, the device embodiments described above are only schematic. For example, the division of the unit is only a logical function division. In actual implementation, there may be another division manner. For example, multiple units or components may be combined or Can be integrated into another system, or some features can be ignored or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, devices or units, which may be electrical, mechanical or other forms.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, may be located in one place, or may be distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the objective of the solution of this embodiment.
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用硬件加软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist separately physically, or two or more units may be integrated into one unit. The above integrated unit may be implemented in the form of hardware, or in the form of hardware plus software functional units.
上述以软件功能单元的形式实现的集成的单元,可以存储在一个计算机可读取存储介质中。上述软件功能单元存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)或处理器(processor)执行本发明各个实施例所述方法的部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、 磁碟或者光盘等各种可以存储程序代码的介质。The above integrated unit implemented in the form of a software functional unit may be stored in a computer-readable storage medium. The software functional unit is stored in a storage medium and includes several instructions for causing a computer device (which may be a personal computer, a server, or a network device) or a processor to execute the methods described in the embodiments of the present invention. Some steps. The aforementioned storage media include: U disks, mobile hard disks, read-only memory (ROM), random access memory (RAM), magnetic disks or compact discs, and other media that can store program codes .
本领域技术人员可以清楚地了解到,为描述的方便和简洁,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。上述描述的装置的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that for the convenience and brevity of the description, only the above-mentioned division of the functional modules is used as an example. In practical applications, the above-mentioned functions can be allocated by different functional modules according to needs, that is, the device The internal structure is divided into different functional modules to complete all or part of the functions described above. For the specific working process of the device described above, reference may be made to the corresponding process in the foregoing method embodiment, and details are not described herein again.
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention, but not limited thereto. Although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art should understand that: It is still possible to modify the technical solutions described in the foregoing embodiments, or to replace some or all of the technical features equivalently; and these modifications or replacements do not depart from the essence of the corresponding technical solutions range.
Claims (32)
- 一种移动机器人控制方法,其特征在于,该方法包括:A mobile robot control method, characterized in that the method includes:获取遥控端发送的控制指令;Obtain the control instructions sent by the remote end;确定所述控制指令的当前执行状态;Determining a current execution state of the control instruction;根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项;Determining, according to the control instruction and the current execution state of the control instruction, at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot;根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,以使得执行端根据调节后的控制指令调整机器人的移动。Adjusting the control instruction according to at least one of the current environment of the robot, the current maneuverability status of the robot, or the current control performance status of the robot, so that the execution end adjusts the movement of the robot according to the adjusted control instruction .
- 根据权利要求1所述的方法,其特征在于,所述确定所述控制指令的当前执行状态包括:获取当前运动参数,其中,所述运动参数包括机器人当前速度,加速度,位置,姿态中的一种或多种。The method according to claim 1, wherein determining the current execution state of the control instruction comprises: obtaining a current motion parameter, wherein the motion parameter includes one of a current speed, acceleration, position, and attitude of the robot Or more.
- 根据权利要求2所述的方法,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The method according to claim 2, wherein the determining is based on the control instruction and the current execution state of the control instruction, at least one of a current environment of the robot, a current state of the robot's performance, or a current state of the control performance of the robot. One item, including:将所述当前运动参数与第一阈值对比得到机器人当前所处环境,其中,所述第一阈值为所述控制指令在标准环境下对应的运动参数。The current motion parameter is compared with a first threshold to obtain the current environment of the robot, wherein the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
- 根据权利要求1所述的方法,其特征在于,所述确定所述控制指令的当前执行状态包括:获取当前机动性能参数,其中,所述机动性能参数包括电机当前转速,扭矩中的一种或多种。The method according to claim 1, wherein determining the current execution state of the control instruction comprises: obtaining a current maneuverability parameter, wherein the maneuverability parameter includes one of a current speed of the motor and a torque or Multiple.
- 根据权利要求4所述的方法,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The method according to claim 4, characterized in that, according to the control instruction and the current execution state of the control instruction, at least one of the environment in which the robot is currently located, the current state of the robot's mobility performance, or the current state of the robot's control performance is determined. One item, including:将所述当前机动性能参数与第二阈值对比得到机器人当前机动性能状态,其中,所述第二阈值为所述控制指令在标准环境下对应的机动性能参数。Comparing the current maneuverability parameter with a second threshold value to obtain the current maneuverability state of the robot, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
- 根据权利要求1所述的方法,其特征在于,所述确定所述控制指令的当前执行状态包括:获取当前控制性能参数,其中,所述控制性能参数 包括调节时间,误差范围中的一种或多种。The method according to claim 1, wherein determining the current execution state of the control instruction comprises: obtaining a current control performance parameter, wherein the control performance parameter includes one of an adjustment time, an error range, or Multiple.
- 根据权利要求6所述的方法,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The method according to claim 6, wherein, according to the control instruction and a current execution state of the control instruction, determining at least one of a current environment of the robot, a current state of the robot's performance, or a current state of the control performance of the robot One item, including:将所述当前控制性能参数与第三阈值对比得到机器人当前控制性能状态,其中,所述第三阈值为所述控制指令在标准环境下对应的控制性能参数。Comparing the current control performance parameter with a third threshold value to obtain the current control performance state of the robot, wherein the third threshold value is a control performance parameter corresponding to the control instruction under a standard environment.
- 根据权利要求1所述的方法,其特征在于,所述控制指令包括速度指令、加速度指令、位置指令、姿态指令中的一种或多种。The method according to claim 1, wherein the control instruction comprises one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
- 根据权利要求1所述的方法,其特征在于,若所述机器人当前所处环境为标准环境,所述机器人当前机动性能状态良好,所述机器人当前控制性能状态良好,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:维持所述控制指令不变。The method according to claim 1, characterized in that, if the current environment of the robot is a standard environment, the current state of the mobile performance of the robot is good, and the current state of the control performance of the robot is good, then, according to the current status of the robot Adjusting the control instruction includes at least one of an environment, a current maneuverability status of the robot, or a current control performance status of the robot, including: maintaining the control instruction unchanged.
- 根据权利要求1所述的方法,其特征在于,若所述机器人当前所处环境为非标准环境,所述机器人当前机动性能状态不良,所述机器人当前控制性能状态不良,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:降低当前加速度和/或速度。The method according to claim 1, characterized in that, if the current environment of the robot is a non-standard environment, the current state of the mobile performance of the robot is poor, and the current state of the control performance of the robot is poor, then the according to the robot Adjusting the control instruction includes at least one of a current environment, a current maneuverability status of the robot, or a current control performance status of the robot, including: reducing a current acceleration and / or speed.
- 根据权利要求10所述的方法,其特征在于,若所述非标准环境为颠簸路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以缓解机器人在颠簸路面的振动。The method according to claim 10, wherein if the non-standard environment is a bumpy road, reducing the current acceleration and / or speed comprises: reducing the current acceleration and speed to alleviate the vibration of the robot on the bumpy road.
- 根据权利要求10所述的方法,其特征在于,若所述非标准环境为光滑路面,所述降低当前加速度和/或速度,包括:降低当前加速度,以使机器人速度与车轮转速匹配。The method according to claim 10, wherein if the non-standard environment is a smooth road, reducing the current acceleration and / or speed comprises: reducing the current acceleration so that the robot speed matches the wheel speed.
- 根据权利要求10所述的方法,其特征在于,若所述非标准环境为泥泞路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以使得机器人可缓慢稳定行驶。The method according to claim 10, wherein if the non-standard environment is a muddy road, reducing the current acceleration and / or speed comprises: reducing the current acceleration and speed so that the robot can run slowly and steadily.
- 根据权利要求1所述的方法,其特征在于,所述移动机器人控制方法还包括:The method according to claim 1, wherein the method for controlling a mobile robot further comprises:获取反馈量,所述反馈量包括电机转速、电机扭矩、机器人速度、机器人加速度、机器人位置、机器人姿态中的一种或多种;Obtaining a feedback amount, which includes one or more of a motor speed, a motor torque, a robot speed, a robot acceleration, a robot position, and a robot posture;根据所述反馈量和所述调节后的控制指令进一步调整机器人的移动。The movement of the robot is further adjusted according to the feedback amount and the adjusted control instruction.
- 根据权利要求1所述的方法,其特征在于,所述移动机器人控制方法还包括,将所述机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端。The method according to claim 1, wherein the mobile robot control method further comprises sending at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot to the remote control. end.
- 一种移动机器人,其特征在于,所述移动机器人包括:主控端、执行端;A mobile robot, characterized in that the mobile robot includes: a main control terminal and an execution terminal;所述主控端,用于获取控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令;The main control terminal is configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot, a current state of the robot's mobility performance according to the control instruction and the current execution state of the control instruction, or Adjusting at least one of a current control performance state of the robot according to at least one of a current environment of the robot, a current maneuverability state of the robot, or a current control performance state of the robot;所述执行端,用于根据调节后的控制指令调整机器人的移动。The execution end is configured to adjust the movement of the robot according to the adjusted control instruction.
- 根据权利要求16所述的移动机器人,其特征在于,所述移动机器人还包括传感器,所述确定所述控制指令的当前执行状态包括:The mobile robot according to claim 16, wherein the mobile robot further comprises a sensor, and the determining a current execution state of the control instruction comprises:从传感器获取当前运动参数,其中,所述运动参数包括机器人当前速度,加速度,位置,姿态中的一种或多种。Acquire a current motion parameter from a sensor, where the motion parameter includes one or more of a robot's current speed, acceleration, position, and attitude.
- 根据权利要求17所述的移动机器人,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The mobile robot according to claim 17, wherein the determining is based on the control instruction and the current execution state of the control instruction, the current environment of the robot, the current state of the robot's performance, or the current state of the control performance of the robot. At least one item, including:将所述当前运动参数与第一阈值对比得到机器人当前所处环境,其中,所述第一阈值为所述控制指令在标准环境下对应的运动参数。The current motion parameter is compared with a first threshold to obtain the current environment of the robot, wherein the first threshold is a motion parameter corresponding to the control instruction under a standard environment.
- 根据权利要求16所述的移动机器人,其特征在于,所述确定所述控制指令的当前执行状态包括:获取当前机动性能参数,其中,所述机动性能参数包括电机当前转速,扭矩中的一种或多种。The mobile robot according to claim 16, wherein the determining the current execution state of the control instruction comprises: obtaining a current maneuverability parameter, wherein the maneuverability parameter includes one of a current speed of the motor and a torque Or more.
- 根据权利要求19所述的移动机器人,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The mobile robot according to claim 19, wherein the determining is based on the control instruction and the current execution state of the control instruction, the current environment of the robot, the current state of the mobile performance of the robot, or the current state of the control performance of the robot. At least one item, including:将所述当前机动性能参数与第二阈值对比得到机器人当前机动性能状态,其中,所述第二阈值为所述控制指令在标准环境下对应的机动性能参数。Comparing the current maneuverability parameter with a second threshold value to obtain the current maneuverability state of the robot, wherein the second threshold value is a maneuverability parameter corresponding to the control instruction under a standard environment.
- 根据权利要求16所述的移动机器人,其特征在于,所述确定控制指令的当前执行状态包括:获取当前控制性能参数,其中,所述控制性能参数包括调节时间,误差范围中的一种或多种。The mobile robot according to claim 16, wherein the determining a current execution state of the control instruction comprises: obtaining a current control performance parameter, wherein the control performance parameter includes one or more of an adjustment time and an error range Species.
- 根据权利要求21所述的移动机器人,其特征在于,所述根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,包括:The mobile robot according to claim 21, wherein, according to the control instruction and a current execution state of the control instruction, determining a current environment of the robot, a current state of the robot's performance, or a current state of the control performance of the robot At least one item, including:将所述当前控制性能参数与第三阈值对比得到机器人当前控制性能状态,其中,所述第三阈值为所述控制指令在标准环境下对应的控制性能参数。Comparing the current control performance parameter with a third threshold value to obtain the current control performance state of the robot, wherein the third threshold value is a control performance parameter corresponding to the control instruction under a standard environment.
- 根据权利要求16所述的移动机器人,其特征在于,所述控制指令包括速度指令、加速度指令、位置指令、姿态指令中的一种或多种。The mobile robot according to claim 16, wherein the control instruction comprises one or more of a speed instruction, an acceleration instruction, a position instruction, and an attitude instruction.
- 根据权利要求16所述的移动机器人,其特征在于,若所述机器人当前所处环境为标准环境,所述机器人当前机动性能状态良好,所述机器人当前控制性能状态良好,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:维持所述控制指令不变。The mobile robot according to claim 16, characterized in that if the current environment of the robot is a standard environment, the current state of the mobile performance of the robot is good, and the current state of the control performance of the robot is good, then the according to the robot Adjusting the control instruction includes at least one of a current environment, a current maneuverability status of the robot, or a current control performance status of the robot, including: maintaining the control instruction unchanged.
- 根据权利要求16所述的移动机器人,其特征在于,若所述机器人当前所处环境为非标准环境,所述机器人当前机动性能状态不良,所述机器人当前控制性能状态不良,则,所述根据机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令,包括:降低当前加速度和/或速度。The mobile robot according to claim 16, characterized in that, if the current environment of the robot is a non-standard environment, the current state of the mobile performance of the robot is poor, and the current state of the control performance of the robot is poor, then Adjusting the control instruction includes at least one of a current environment of the robot, a current maneuverability status of the robot, or a current control performance status of the robot, including: reducing a current acceleration and / or speed.
- 根据权利要求25所述的移动机器人,其特征在于,若所述非标准环境为颠簸路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以缓解机器人在颠簸路面的振动。The mobile robot according to claim 25, wherein if the non-standard environment is a bumpy road, reducing the current acceleration and / or speed comprises: reducing the current acceleration and speed to relieve the vibration of the robot on a bumpy road .
- 根据权利要求25所述的移动机器人,其特征在于,若所述非标准环境为光滑路面,所述降低当前加速度和/或速度,包括:降低当前加速度,以使机器人速度与车轮转速匹配。The mobile robot according to claim 25, wherein if the non-standard environment is a smooth road, reducing the current acceleration and / or speed comprises: reducing the current acceleration so that the robot speed matches the wheel speed.
- 根据权利要求25所述的移动机器人,其特征在于,若所述非标准环境为泥泞路面,所述降低当前加速度和/或速度,包括:降低当前加速度和速度,以使得机器人可缓慢稳定行驶。The mobile robot according to claim 25, wherein if the non-standard environment is a muddy road, the reducing the current acceleration and / or speed comprises: reducing the current acceleration and speed so that the robot can run slowly and stably.
- 根据权利要求16所述的移动机器人,其特征在于,所述主控端包括机动性能调节器和控制器;The mobile robot according to claim 16, wherein the main control end comprises a maneuverability adjuster and a controller;所述机动性能调节器,具体用于获取控制指令,确定所述控制指令的当前执行状态,根据所述控制指令和所述控制指令的当前执行状态确定机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项,根据所述机器人当前所处环境、所述机器人当前机动性能状态、或所述机器人当前控制性能状态中至少一项,调节所述控制指令;The maneuverability adjuster is specifically configured to obtain a control instruction, determine a current execution state of the control instruction, and determine a current environment of the robot and a current maneuverability status of the robot according to the control instruction and the current execution state of the control instruction. Or at least one of the current control performance state of the robot, and adjusting the control instruction according to at least one of the current environment of the robot, the current maneuverability state of the robot, or the current control performance state of the robot;所述控制器,具体用于获取调节后的控制指令和反馈量,所述反馈量包括电机转速、电机扭矩、机器人速度、机器人加速度、机器人位置、机器人姿态中的一种或多种;The controller is specifically configured to obtain an adjusted control instruction and a feedback amount, where the feedback amount includes one or more of motor speed, motor torque, robot speed, robot acceleration, robot position, and robot attitude;所述控制器,还用于根据所述调节后的控制指令和所述反馈量确定所述执行端的输入,以使得执行端进一步调整机器人的移动。The controller is further configured to determine an input of the execution end according to the adjusted control instruction and the feedback amount, so that the execution end further adjusts the movement of the robot.
- 根据权利要求16所述的移动机器人,其特征在于,所述主控端还用于将所述机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端,以使得遥控端中的显示区显示所述机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项。The mobile robot according to claim 16, wherein the main control end is further configured to send at least one of the environment in which the robot is currently located, the current state of the mobile performance of the robot, or the current state of the control performance of the robot to the remote control So that the display area in the remote control terminal displays at least one of the environment in which the robot is currently located, the current maneuverability status of the robot, or the current control performance status of the robot.
- 一种移动机器人控制系统,其特征在于,所述控制系统包括遥控端和权利要求16至30任一所述的移动机器人,所述遥控端用于生成控制指令并发送给移动机器人。A mobile robot control system, characterized in that the control system includes a remote control terminal and the mobile robot according to any one of claims 16 to 30, and the remote control terminal is configured to generate a control instruction and send the control instruction to the mobile robot.
- 根据权利要求31所述的移动机器人控制系统,其特征在于,The mobile robot control system according to claim 31, wherein:所述主控端还用于将机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项发送给遥控端;The master control terminal is further configured to send at least one of a current environment of the robot, a current mobility performance state of the robot, or a current control performance state of the robot to the remote control terminal;所述遥控端还包括显示区,所述显示区用于显示机器人当前所处环境、机器人当前机动性能状态、或机器人当前控制性能状态中至少一项。The remote end further includes a display area for displaying at least one of the environment in which the robot is currently located, the current state of the mobile performance of the robot, or the current state of the control performance of the robot.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/103979 WO2020047746A1 (en) | 2018-09-04 | 2018-09-04 | Mobile robot control method and system, and mobile robot |
CN201880017015.5A CN110419014A (en) | 2018-09-04 | 2018-09-04 | Control method, system and the mobile robot of mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/103979 WO2020047746A1 (en) | 2018-09-04 | 2018-09-04 | Mobile robot control method and system, and mobile robot |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020047746A1 true WO2020047746A1 (en) | 2020-03-12 |
Family
ID=68357868
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2018/103979 WO2020047746A1 (en) | 2018-09-04 | 2018-09-04 | Mobile robot control method and system, and mobile robot |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110419014A (en) |
WO (1) | WO2020047746A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113791609A (en) * | 2021-02-02 | 2021-12-14 | 北京京东乾石科技有限公司 | Control method, control device, storage medium, and electronic apparatus |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7840308B2 (en) * | 2004-09-10 | 2010-11-23 | Honda Motor Co., Ltd. | Robot device control based on environment and position of a movable robot |
CN102890508A (en) * | 2011-07-22 | 2013-01-23 | 鸿奇机器人股份有限公司 | Self-propelled electronic device and method for controlling behavior of self-propelled electronic device |
CN106292699A (en) * | 2016-08-03 | 2017-01-04 | 广州极飞电子科技有限公司 | Method, device and the unmanned plane that unmanned plane flies imitatively |
CN106444800A (en) * | 2016-08-01 | 2017-02-22 | 中国人民武装警察部队总医院 | External safety control apparatus, method and system for flight of multi-rotor unmanned plane |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3862482B2 (en) * | 2000-06-29 | 2006-12-27 | 株式会社日立製作所 | Anti-skid control device |
JP6260216B2 (en) * | 2013-11-13 | 2018-01-17 | 富士通株式会社 | Concavity and convexity analysis program, concavo-convex analysis method and concavo-convex analysis apparatus |
WO2016065627A1 (en) * | 2014-10-31 | 2016-05-06 | 深圳市大疆创新科技有限公司 | Location-based control method and apparatus, mobile machine and robot |
KR101659037B1 (en) * | 2015-02-16 | 2016-09-23 | 엘지전자 주식회사 | Robot cleaner, remote controlling system and method of the same |
CN106325270B (en) * | 2016-08-12 | 2019-05-31 | 天津大学 | Intelligent vehicle air navigation aid based on perception and from host computer location navigation |
CN106444754A (en) * | 2016-09-21 | 2017-02-22 | 哈尔滨理工大学 | Wheel-type detection mobile robot control system and method |
CN106647743A (en) * | 2016-10-26 | 2017-05-10 | 纳恩博(北京)科技有限公司 | Control method of electronic device and electronic device |
-
2018
- 2018-09-04 WO PCT/CN2018/103979 patent/WO2020047746A1/en active Application Filing
- 2018-09-04 CN CN201880017015.5A patent/CN110419014A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7840308B2 (en) * | 2004-09-10 | 2010-11-23 | Honda Motor Co., Ltd. | Robot device control based on environment and position of a movable robot |
CN102890508A (en) * | 2011-07-22 | 2013-01-23 | 鸿奇机器人股份有限公司 | Self-propelled electronic device and method for controlling behavior of self-propelled electronic device |
CN106444800A (en) * | 2016-08-01 | 2017-02-22 | 中国人民武装警察部队总医院 | External safety control apparatus, method and system for flight of multi-rotor unmanned plane |
CN106292699A (en) * | 2016-08-03 | 2017-01-04 | 广州极飞电子科技有限公司 | Method, device and the unmanned plane that unmanned plane flies imitatively |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113791609A (en) * | 2021-02-02 | 2021-12-14 | 北京京东乾石科技有限公司 | Control method, control device, storage medium, and electronic apparatus |
Also Published As
Publication number | Publication date |
---|---|
CN110419014A (en) | 2019-11-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20210157217A1 (en) | Gimbal control method, gimbal control apparatus, and gimbal | |
US8947522B1 (en) | Systems and methods to adjust actions based on latency levels | |
JP2017516117A (en) | Accelerator response method, apparatus, program, and recording medium | |
Loianno et al. | Smartphones power flying robots | |
CN112262357A (en) | Determining control parameters for formation of multiple UAVs | |
US11865731B2 (en) | Systems, apparatuses, and methods for dynamic filtering of high intensity broadband electromagnetic waves from image data from a sensor coupled to a robot | |
WO2022247169A1 (en) | Admittance control method for robot, admittance control system, and robot | |
WO2021016985A1 (en) | Gimbal control method, controller, gimbal, unmanned mobile platform, and storage medium | |
US11347242B2 (en) | Methods and apparatus for flight control prioritization | |
US20210232149A1 (en) | Systems and methods for persistent mapping of environmental parameters using a centralized cloud server and a robotic network | |
KR101605994B1 (en) | Adaptive leader-follower formation control method and apparatus with unknown skidding and slipping effect | |
WO2020047746A1 (en) | Mobile robot control method and system, and mobile robot | |
CN108089597B (en) | Method and device for controlling unmanned aerial vehicle based on ground station | |
JP7196189B2 (en) | Method, device and control system for controlling a mobile robot | |
WO2021068980A1 (en) | Three-dimensional map generation method, mobile apparatus, and computer readable storage medium | |
TW202032366A (en) | Systems and methods for improved control of nonholonomic robotic systems | |
US11947350B2 (en) | Devices, systems, and methods for operating intelligent vehicles using separate devices | |
US11392092B2 (en) | Information processing device and information processing method | |
WO2020248132A1 (en) | Control method and apparatus for movable platform, device, and storage medium | |
JP2021165875A (en) | Control platform and control method | |
CN108334105A (en) | The method and device that unmanned plane is controlled based on communication command vehicle | |
CN110000782B (en) | Incomplete robot shaking removal control method based on sliding-mode observer | |
CN113110547B (en) | Flight control method, device and equipment of miniature aviation aircraft | |
WO2020042062A1 (en) | Drift control method and device for ground remote control robot, and ground remote control robot | |
CN118789523A (en) | Mechanical arm dragging teaching method, device, equipment, medium and product |
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: 18932570 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: 18932570 Country of ref document: EP Kind code of ref document: A1 |