CN110065062A - A kind of motion control method of articulated robot - Google Patents

A kind of motion control method of articulated robot Download PDF

Info

Publication number
CN110065062A
CN110065062A CN201810068880.4A CN201810068880A CN110065062A CN 110065062 A CN110065062 A CN 110065062A CN 201810068880 A CN201810068880 A CN 201810068880A CN 110065062 A CN110065062 A CN 110065062A
Authority
CN
China
Prior art keywords
articulated robot
leg
joint
control method
motion control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201810068880.4A
Other languages
Chinese (zh)
Inventor
王拴绪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Robotics Research Institute Co Ltd
Original Assignee
Nanjing Robotics Research Institute Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing Robotics Research Institute Co Ltd filed Critical Nanjing Robotics Research Institute Co Ltd
Priority to CN201810068880.4A priority Critical patent/CN110065062A/en
Publication of CN110065062A publication Critical patent/CN110065062A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697Vision controlled systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

The present invention relates to a kind of motion control method of articulated robot, the motion control method of the articulated robot is the following steps are included: detect the movement velocity of articulated robot, if the movement velocity is greater than preset value;Obtain the posture information of articulated robot, the centroid position coordinate of each connecting rod of articulated robot is obtained from the posture information, the practical yaw moment that articulated robot is calculated according to the centroid position coordinate of each connecting rod, judges whether the practical yaw moment is greater than default foot maximum static friction torque;The practical yaw moment is greater than the default foot maximum static friction torque, then leg articulated driving equipment adjustment leg joint angles become larger, so that articulated robot generates acceleration straight down.

Description

A kind of motion control method of articulated robot
Technical field
The present invention relates to robotic technology field more particularly to a kind of motion control methods of articulated robot.
Background technique
The anthropomorphic robot occurred earliest in real world should first elect Waseda University in 1973 and add one youth research department of rattan The early stage robot of exploitation.Although technology be not also it is very mature, early stage, robot can also be led to by visual identity object It crosses the sense of hearing and speech synthesis and people carries out verbal communication, moreover it is possible to be operated, can be used double by tactile both hands team object Foot walking.Then there are the appearance of mirable P2, P3, ASIMO again, to the appearance of NAO in 2008, each side of anthropomorphic robot Surface technology is being continuously updated.
In terms of Humanoid Robot Based on Walking, also there is some other method, such as the side of the planning joint trajectories of S. Kajita Method is analyzed the position and angle value of ankle-joint and hip joint under each state, these characteristic points in a walking cycle and is retouched Determine the full curve of joint motions out after stating again.This method is computationally intensive also to become dependent upon external environment model, for certainly By spending more robots, Dynamic Equation is sometimes even unsolvable;The center model generator of S.Grillner, is base It in the analysis method of neural network, is initialized by non-oscillatory signal, then generates cyclical signal in self-contained method Circuit system.This method is not necessarily to carry out dynamic model to robot and external environment, but can not accurately obtain and nerve is connected The series of parameters value such as weight;The trajectory walking method of M.Ogino is to be obtained by observing mankind's walking manner, only exists The starting and ending stage of swing just drives free leg.A trajectory walking namely traveling controller, during the motion, Free leg is by gravity and the coefficient result of inertia force swinging intermediate time.This method is establishing high energy walking model Aspect has good application.
In the process of walking, body is easy disequilibrium for robot, and the robot with hip joint usually passes through hip joint Rotation to keep the balance of robot;The body of robot is realized in the swing that robot with swing arm usually passes through both arms Body balance, but some articulated robots do not have hip joint and swing arm, how to solve robot indoor navigation system route rule The balance for drawing accurate problem and control articulated robot body in the process of walking, becomes those skilled in the art and urgently solves Technical problem certainly.
Summary of the invention
The object of the present invention is to provide a kind of motion control methods of articulated robot, can not only solve robot chamber Interior navigation system route planning accurate problem, moreover it is possible to solve how to control articulated robot balance in the process of walking Problem.
To achieve the goals above, the present invention provides a kind of motion control method of articulated robot, more passes Save robot motion control method the following steps are included:
Step S01, indoor environment map is obtained, and indoor environment model is created according to the indoor environment cartographic information;
Step S02, the indoor scene information with obvious characteristic is obtained as road sign, and global route is divided into road sign and road sign Between markings;
Step S03, the physical location of sniffing robot and road sign determines the position of articulated robot;
Step S04, articulated robot in the process of walking, detects markings by visual detection sensor, and adjust Deviation between travelling route and normal line;
Step S05, the movement velocity of articulated robot is detected, if the movement velocity is greater than preset value;
Step S06, the posture information for obtaining articulated robot obtains each connecting rod of articulated robot from the posture information Centroid position coordinate calculates the practical yaw moment of articulated robot according to the centroid position coordinate of each connecting rod, judges institute State whether practical yaw moment is greater than default foot maximum static friction torque;
Step S07, the described practical yaw moment is greater than the default foot maximum static friction torque, then leg articulated driving equipment Adjustment leg joint angles become larger, so that articulated robot generates acceleration straight down.
Preferably, the leg link of the articulated robot connects foot by ankle-joint, and the foot installation is strong to be passed Sensor, the force snesor is for measuring torque suffered by the foot.
Preferably, the leg articulated driving equipment includes controller, motor and retarder, the control letter of the controller Number output end connects the control signal input of the motor, and the power output end of the motor connects the power of the retarder Input terminal, the retarder drives the leg articulation, to adjust the angle in leg joint.
Preferably, the leg joint has the rotation axis of both direction, and the retarder controls the leg joint Rotation axis rotation in both directions, to become larger or reduce the angle in leg joint.
Preferably, the retarder and the leg joint are coaxially disposed.
Preferably, the coordinate origin of the centroid position coordinate of each connecting rod is the contact point of supporting leg and ground.
Preferably, the leg joint is equipped with joint torque sensor, and the joint torque sensor connected legs is closed Section and leg link, the joint torque sensor is for detecting torque suffered by the joint of leg.
Preferably, in step S04, the visual detection sensor detects markings, including visual detection sensing Device obtains the one or more image of scenery on markings, carries out edge extracting, image segmentation, image thinning to described image, Obtain the road sign in image.
Preferably, in step S01, the acquisition indoor environment map, comprising: according to the location information of robot, machine The initial attitude and indoor arrangement map of people, obtains indoor environment map.
Preferably, in step S02, the markings global route being divided between road sign and road sign, comprising: from institute The initial position for stating robot is split global route, identifies the scape with obvious characteristic on the indoor environment map Object, using the scene information of the scenery as road sign, by mark between adjacent road sign at mark on the route divided at every section Line.
The motion control method of articulated robot provided by the invention has the advantages that
1, indoor environment map is established, establishes the markings for being used to indicate robot physical location on environmental map indoors, is led to The deviation between the practical travelling route of visual detection sensor correction robot and normal line is crossed, by navigation map and travelling route Real-time detection combines, and substantially increases the accuracy of indoor navigation, while reducing the computational burden of robot, improves machine The operational efficiency of device people;
2, when the movement velocity of articulated robot is excessive, whether the practical yaw moment for detecting articulated robot is greater than default foot Maximum static friction torque, the practical yaw moment of articulated robot is greater than default foot maximum static friction torque, by support Leg leg joint is controlled, and the center of gravity of articulated robot is reduced so that articulated robot generate in vertical direction one to Under acceleration, to increase foot static friction torque, to maintain the equalising torque of vertical direction.This method can be used for no hip In joint or robot without upper limb, the balance of articulated robot in the process of walking can be effectively controlled.
Detailed description of the invention
Fig. 1 is that a kind of process of specific embodiment of the motion control method of articulated robot provided by the invention is shown It is intended to.
Specific embodiment
Below in conjunction with the attached drawing in the embodiment of the present application, technical solutions in the embodiments of the present application carries out clear, complete Site preparation description, it is clear that described embodiments are only a part of embodiments of the present application, instead of all the embodiments.It is based on Embodiment in the application, it is obtained by those of ordinary skill in the art without making creative efforts every other Embodiment shall fall in the protection scope of this application.
Fig. 1 is please referred to, Fig. 1 is a kind of specific embodiment party of the motion control method of articulated robot provided by the invention The flow diagram of formula.
As shown in Figure 1, the present invention provides a kind of motion control method of articulated robot, the articulated robot Motion control method the following steps are included:
Step S01, indoor environment map is obtained, and indoor environment model is created according to the indoor environment cartographic information;
Step S02, the indoor scene information with obvious characteristic is obtained as road sign, and global route is divided into road sign and road sign Between markings;
Step S03, the physical location of sniffing robot and road sign determines the position of articulated robot;
Step S04, articulated robot in the process of walking, detects markings by visual detection sensor, and adjust Deviation between travelling route and normal line;
Step S05, the movement velocity of articulated robot is detected, if the movement velocity is greater than preset value;
Step S06, the posture information for obtaining articulated robot obtains each connecting rod of articulated robot from the posture information Centroid position coordinate calculates the practical yaw moment of articulated robot according to the centroid position coordinate of each connecting rod, judges institute State whether practical yaw moment is greater than default foot maximum static friction torque;
Step S07, the described practical yaw moment is greater than the default foot maximum static friction torque, then leg articulated driving equipment Adjustment leg joint angles become larger, so that articulated robot generates acceleration straight down.
The present invention establishes indoor environment map, establishes the mark for being used to indicate robot physical location on environmental map indoors Will line corrects the deviation between the practical travelling route of robot and normal line by visual detection sensor, by navigation map with Travelling route real-time detection combines, and substantially increases the accuracy of indoor navigation, while reducing the computational burden of robot, Improve the operational efficiency of robot.
The motion control method of articulated robot provided by the invention, when the movement velocity of articulated robot is excessive, inspection Whether the practical yaw moment for surveying articulated robot is greater than default foot maximum static friction torque, the practical beat of articulated robot Torque, which is greater than default foot maximum static friction torque, reduces articulated robot by controlling supporting leg leg joint Center of gravity, so that articulated robot generates a downward acceleration in vertical direction, to increase foot static friction torque, thus Maintain the equalising torque of vertical direction.This method can be used in no hip joint or robot without upper limb, can effectively control The balance of articulated robot in the process of walking.
In preferred scheme, the leg link of the articulated robot connects foot, the foot installation by ankle-joint Force sensor, the force snesor is for measuring torque suffered by the foot.
In preferred scheme, the leg articulated driving equipment includes controller, motor and retarder, the controller Control signal output connects the control signal input of the motor, and the power output end of the motor connects the retarder Power intake, the retarder drives the leg articulation, to adjust the angle in leg joint.
In preferred scheme, the leg joint has the rotation axis of both direction, and the retarder controls the leg The rotation axis rotation of portion joint in both directions, to become larger or reduce the angle in leg joint.
In preferred scheme, the retarder and the leg joint are coaxially disposed.
In preferred scheme, the coordinate origin of the centroid position coordinate of each connecting rod is contact of the supporting leg with ground Point.
In preferred scheme, the leg joint is equipped with joint torque sensor, the joint torque sensor connection Leg joint and leg link, the joint torque sensor is for detecting torque suffered by the joint of leg.
In preferred scheme, in step S04, the visual detection sensor detects markings, including vision is visited The one or more image that sensor obtains scenery on markings is surveyed, edge extracting, image segmentation, image are carried out to described image Refinement obtains the road sign in image.
In preferred scheme, in step S01, the acquisition indoor environment map, comprising: believed according to the position of robot Breath, the initial attitude of robot and indoor arrangement map, obtain indoor environment map.
It is described that global route is divided into the markings between road sign and road sign in step S02 in preferred scheme, packet It includes: global route being split from the initial position of the robot, identify having obviously on the indoor environment map The scenery of feature will be marked using the scene information of the scenery as road sign on the route divided at every section between adjacent road sign Know into markings.
Structure, feature and effect of the invention, the above institute are described in detail based on the embodiments shown in the drawings Only presently preferred embodiments of the present invention is stated, but the present invention does not limit the scope of implementation as shown in the drawings, it is all according to structure of the invention Think made change or equivalent example modified to equivalent change, when not going beyond the spirit of the description and the drawings, It should all be within the scope of the present invention.

Claims (10)

1. a kind of motion control method of articulated robot, which is characterized in that the motion control side of the articulated robot Method the following steps are included:
Step S01, indoor environment map is obtained, and indoor environment model is created according to the indoor environment cartographic information;
Step S02, the indoor scene information with obvious characteristic is obtained as road sign, and global route is divided into road sign and road sign Between markings;
Step S03, the physical location of sniffing robot and road sign determines the position of articulated robot;
Step S04, articulated robot in the process of walking, detects markings by visual detection sensor, and adjust Deviation between travelling route and normal line;
Step S05, the movement velocity of articulated robot is detected, if the movement velocity is greater than preset value;
Step S06, the posture information for obtaining articulated robot obtains each connecting rod of articulated robot from the posture information Centroid position coordinate calculates the practical yaw moment of articulated robot according to the centroid position coordinate of each connecting rod, judges institute State whether practical yaw moment is greater than default foot maximum static friction torque;
Step S07, the described practical yaw moment is greater than the default foot maximum static friction torque, then leg articulated driving equipment Adjustment leg joint angles become larger, so that articulated robot generates acceleration straight down.
2. the motion control method of articulated robot according to claim 1, which is characterized in that the articulated robot Leg link foot is connected by ankle-joint, the foot installs force sensor, and the force snesor is described for measuring Torque suffered by foot.
3. the motion control method of articulated robot according to claim 2, which is characterized in that drive in the leg joint Dynamic device includes controller, motor and retarder, and the control signal output of the controller connects the control letter of the motor Number input terminal, the power output end of the motor connect the power intake of the retarder, and the retarder drives the leg Portion's articulation, to adjust the angle in leg joint.
4. the motion control method of articulated robot according to claim 3, which is characterized in that the leg joint tool There are two the rotation axis in direction, the retarder controls the rotation axis rotation of the leg joint in both directions, to become Angle that is big or reducing leg joint.
5. the motion control method of articulated robot according to claim 4, which is characterized in that the retarder and institute State the coaxial arrangement of leg joint.
6. the motion control method of articulated robot according to claim 5, which is characterized in that the matter of each connecting rod The coordinate origin of heart position coordinates is the contact point of supporting leg and ground.
7. the motion control method of articulated robot according to claim 1, which is characterized in that on the leg joint Equipped with joint torque sensor, joint torque sensor connected legs joint and leg link, the joint torque sensing Device is for detecting torque suffered by the joint of leg.
8. the motion control method of articulated robot according to claim 1, which is characterized in that described in step S04 Visual detection sensor detects markings, and the one or more of scenery on markings are obtained including visual detection sensor Image carries out edge extracting, image segmentation, image thinning to described image, obtains the road sign in image.
9. the motion control method of articulated robot according to claim 1, which is characterized in that described in step S01 Obtain indoor environment map, comprising: according to the location information of robot, the initial attitude of robot and indoor arrangement map, obtain To indoor environment map.
10. navigation control method in robot chamber according to claim 1, which is characterized in that described to incite somebody to action in step S02 Global route is divided into the markings between road sign and road sign, comprising: from the initial position of the robot to global route into Row segmentation, identifies the scenery with obvious characteristic on the indoor environment map, using the scene information of the scenery as road sign, By mark between adjacent road sign at markings on the route divided at every section.
CN201810068880.4A 2018-01-24 2018-01-24 A kind of motion control method of articulated robot Pending CN110065062A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810068880.4A CN110065062A (en) 2018-01-24 2018-01-24 A kind of motion control method of articulated robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810068880.4A CN110065062A (en) 2018-01-24 2018-01-24 A kind of motion control method of articulated robot

Publications (1)

Publication Number Publication Date
CN110065062A true CN110065062A (en) 2019-07-30

Family

ID=67365550

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810068880.4A Pending CN110065062A (en) 2018-01-24 2018-01-24 A kind of motion control method of articulated robot

Country Status (1)

Country Link
CN (1) CN110065062A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113467246A (en) * 2021-07-16 2021-10-01 浙江大学 Yaw moment compensation method for biped robot
CN116491935A (en) * 2023-06-29 2023-07-28 深圳市微克科技有限公司 Exercise health monitoring method, system and medium of intelligent wearable equipment

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201313307Y (en) * 2008-11-10 2009-09-23 战强 Spherical environment detection robot
CN101762277A (en) * 2010-02-01 2010-06-30 北京理工大学 Six-degree of freedom position and attitude determination method based on landmark navigation
CN102448683A (en) * 2009-07-02 2012-05-09 松下电器产业株式会社 Robot, control device for robot arm, and control program for robot arm
KR20130049029A (en) * 2011-11-03 2013-05-13 삼성전자주식회사 Walking robot and control method for thereof
CN103217903A (en) * 2013-04-07 2013-07-24 南京邮电大学 Method for kicking ball at all directions by humanoid soccer robot based on double-balance control mechanism
CN104793622A (en) * 2014-01-20 2015-07-22 丰田自动车株式会社 Biped walking robot control method and biped walking robot control system
CN106933100A (en) * 2017-03-19 2017-07-07 北京工业大学 A kind of humanoid robot gait's planing method based on human body motion capture data
CN107368079A (en) * 2017-08-31 2017-11-21 珠海市微半导体有限公司 Robot cleans the planing method and chip in path
CN107443385A (en) * 2017-09-26 2017-12-08 珠海市微半导体有限公司 The detection method and chip and robot of the robot line navigation of view-based access control model

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201313307Y (en) * 2008-11-10 2009-09-23 战强 Spherical environment detection robot
CN102448683A (en) * 2009-07-02 2012-05-09 松下电器产业株式会社 Robot, control device for robot arm, and control program for robot arm
CN101762277A (en) * 2010-02-01 2010-06-30 北京理工大学 Six-degree of freedom position and attitude determination method based on landmark navigation
KR20130049029A (en) * 2011-11-03 2013-05-13 삼성전자주식회사 Walking robot and control method for thereof
CN103217903A (en) * 2013-04-07 2013-07-24 南京邮电大学 Method for kicking ball at all directions by humanoid soccer robot based on double-balance control mechanism
CN104793622A (en) * 2014-01-20 2015-07-22 丰田自动车株式会社 Biped walking robot control method and biped walking robot control system
CN106933100A (en) * 2017-03-19 2017-07-07 北京工业大学 A kind of humanoid robot gait's planing method based on human body motion capture data
CN107368079A (en) * 2017-08-31 2017-11-21 珠海市微半导体有限公司 Robot cleans the planing method and chip in path
CN107443385A (en) * 2017-09-26 2017-12-08 珠海市微半导体有限公司 The detection method and chip and robot of the robot line navigation of view-based access control model

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
刘洞波: "《移动机器人粒子滤波定位与地图创建》", 30 September 2016, 湘潭大学出版社 *
曹其新: "《轮式自主移动机器人》", 31 January 2012, 上海交通大学出版社 *
杨亮: "基于腿部关节控制的仿人机器人偏摆力矩控制方法", 《控制与决策》 *
王一丁: "《数字图像处理》", 31 August 2015, 西安电子科技大学出版社 *
邵欣: "《机器视觉与传感器技术》", 31 August 2017, 北京航空航天大学出版社 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113467246A (en) * 2021-07-16 2021-10-01 浙江大学 Yaw moment compensation method for biped robot
CN113467246B (en) * 2021-07-16 2023-10-20 浙江大学 Offset moment compensation method for biped robot
CN116491935A (en) * 2023-06-29 2023-07-28 深圳市微克科技有限公司 Exercise health monitoring method, system and medium of intelligent wearable equipment
CN116491935B (en) * 2023-06-29 2023-08-29 深圳市微克科技有限公司 Exercise health monitoring method, system and medium of intelligent wearable equipment

Similar Documents

Publication Publication Date Title
US8873831B2 (en) Walking robot and simultaneous localization and mapping method thereof
CN108563220A (en) The motion planning of apery Soccer robot
CN110065065A (en) A kind of articulated robot ambulation control method
JP2013000878A (en) Balance control device for robot, and control method for the same
CN113793360B (en) Three-dimensional human body reconstruction method based on inertial sensing technology
Zheng et al. Pedalvatar: An IMU-based real-time body motion capture system using foot rooted kinematic model
CN109470238A (en) A kind of localization method, device and mobile terminal
CN107877493A (en) Robot system and its application process are assisted in a kind of the elderly's indoor activity in
CN109079794A (en) It is a kind of followed based on human body attitude robot control and teaching method
CN110065062A (en) A kind of motion control method of articulated robot
CN104887237B (en) A kind of pedestrian navigation method based on human motion mode monitoring
Jianhua Design and kinematic simulation for Six-DOF leg mechanism of hexapod robot
CN206473763U (en) A kind of wearable device for adjusting stroke
CN109044753A (en) A kind of man-machine body feeling interaction blind-guidance robot and working method
JP2018513496A (en) Foot contact position tracking device, method for controlling movement thereof, computer-executable program, and computer-readable non-transitory information recording medium storing the same
CN116619382A (en) Robot motion control method and system and electronic equipment
CN105549592B (en) A kind of intelligent spherical robot and its control method with faults-tolerant control
KR20170138977A (en) Walking robot and simultaneous localization and mapping method thereof
CN113126659B (en) System and method for detecting jumping and landing state of humanoid robot
JP6333688B2 (en) Mobile robot controller
CN113283116A (en) Multi-information fusion human motion analysis method and device
JP2016093853A (en) Control system of mobile robot
Kondo et al. Real-time posture imitation of biped humanoid robot based on particle filter with simple joint control for standing stabilization
Yi et al. Active stabilization of a humanoid robot for real-time imitation of a human operator
CN111565897A (en) Animal-shaped autonomous moving object, method for operating animal-shaped autonomous moving object, and program

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20190730

RJ01 Rejection of invention patent application after publication