CN202583882U - Lower limb motion planning system for biped robot in obstacle crossing - Google Patents
Lower limb motion planning system for biped robot in obstacle crossing Download PDFInfo
- Publication number
- CN202583882U CN202583882U CN 201120554659 CN201120554659U CN202583882U CN 202583882 U CN202583882 U CN 202583882U CN 201120554659 CN201120554659 CN 201120554659 CN 201120554659 U CN201120554659 U CN 201120554659U CN 202583882 U CN202583882 U CN 202583882U
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- signal output
- signal input
- planning system
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
The utility model relates to a lower limb motion planning system for a biped robot in obstacle crossing, which comprises a robot controller, an action executor, joint motors and an obstacle detecting module. A signal output end of the obstacle detecting module for detecting conditions in front of the robot is connected with a signal input end of the robot controller. A control signal output end of the robot controller is connected with a signal input end of the action executor, and a signal output end of the action executor is connected with signal input ends of the joint motors for driving joints to move. The lower limb motion planning system is used for planning motion of the corresponding joints of the robot by referring to the obstacle crossing mode of humans and by means of closed loop feedback, so that the robot stably crosses obstacles encountered in the process of walking. Motion planned by the lower limb motion planning system effectively uses the joints of lower limbs of the robot, and the lower limb motion planning system for the biped robot in obstacle crossing is natural and stable and conforms to human motion characteristics, so that adaptability of the robot to complicated environments is enhanced.
Description
Technical field
The utility model relates to a kind of lower extremity movement planning system of biped robot's across obstacle; Be specifically related to run into barrier in a kind of biped robot's walking process; The motion planning system in each joint of lower limb belongs to the renovation technique of biped robot's motion planning system.
Background technology
Robot is the interdisciplinary study that developed recently gets up.It has concentrated multi-disciplinary latest scientific research such as mechanical engineering, electronic engineering, computer engineering, automatic control engineering and artificial intelligence, has represented the overachievement of electromechanical integration, is one of present development in science and technology most active fields.
At present the move mode of robot comprise wheeled, crawler type, walking, creep, wriggling etc.Wheeled, crawler type motion itself is ripe, research wheeled, caterpillar mobile robot is mainly concentrated in the autokinetic movement control, but this dual mode environment space is had relatively high expectations, thereby its range of application receives certain restriction.Creep and the crawling type robot is mainly used in operation in pipeline and other narrow space, have good quiet, dynamic stability, but translational speed is slower.Bipod walking robot is compared with wheeled, caterpillar type robot has many outstanding superiority:
(1) bipod walking robot can adapt to various ground and have the higher ability of going beyond obstacle, up/down steps and through out-of-flatness, irregular or easily than the narrow lane face, and its mobile " blind area " is very little;
(2) energy consumption of bipod walking robot is very little.Because this robot can have independently energy source device, therefore when design, just should take into full account its energy consumption problem.The robot mechanics calculates and shows that also the energy consumption of legged type robot is usually less than wheeled and crawler type;
(3) bipod walking robot has wide work space.Because the floor area of running gear is little, and scope of activities is very big, institute thinks that the mechanical arm of its configuration provides bigger activity space, the while also can make mechanical arm design comparatively short and small compactness;
(4) to walk upright be the highest walking of organic sphere difficulty action to biped.But its walking performance is that other walking structure is incomparable.Therefore, the development of walking robot changes robot construction has higher requirement, simultaneously the also effectively development of propel machine people and other related disciplines.
Anthropomorphic robot is the many-degrees of freedom system of rare high-order on the engineering, non-linear, nonholonomic constraint.The research of this kinematics to robot, dynamics and control theory provides a very desirable experiment porch; # causes the generation of new theory, new method in mechanics and the control field probably in to the process of its research; In addition, the research of anthropomorphic robot can also promote the development of related disciplines such as bionics, artificial intelligence, computer graphical, communication.Therefore, the development of apery walking robot has very great value and significance.
Among the great number of issues of biped robot research, biped robot's action planning is that the emphasis of robot research also is a difficult point, and can access actions such as double feet walking as people's steady and continuous, across obstacle is the final goal that the biped robot studies.
The barrier that differing heights crossed over smoothly by robot belongs to a kind of of robot compound movement, also is a compound movement in the simulating human daily life.When particularly robot was operated out of doors, the barrier that robot runs into differing heights was unavoidable.Therefore farthest reduce by barrier and stumble and the injury that brings, and when running into barrier, steadily stride across barrier, continue walking forward, become the emphasis of research.
The utility model content
The purpose of the utility model is to consider the problems referred to above and a kind of lower extremity movement planning system of natural, biped robot's across obstacle of stablizing, meeting the human motion characteristic is provided.The utility model is reasonable in design, and is convenient and practical.
The technical scheme of the utility model is: the lower extremity movement planning system of biped robot's across obstacle of the utility model; Include robot controller, actuator, each joint motor, detection of obstacles module; Wherein the signal output part of the detection of obstacles module of detection machine people the place ahead situation is connected with the signal input part of robot controller; The control signal output ends of robot controller is connected with the signal input part of actuator, and the signal output part of actuator is connected with the signal input part of each joint motor that drives each joint motions.
Above-mentioned actuator comprises multi-joint controller, power driving circuit, photoelectric encoder and comparator circuit; Wherein the control signal output ends of robot controller is connected with the signal input part of multi-joint controller; The signal output part of multi-joint controller is connected with the signal input part of power driving circuit; The signal output part of power driving circuit is connected with the signal input part of each joint motor that drives each joint motions; And the signal output part of photoelectric encoder that detects the moving situation of each joint motor is connected with the signal input part of comparator circuit, and the signal output part of comparator circuit is connected with the signal input part of multi-joint controller.
Above-mentioned each joint motor is a servomotor.
Above-mentioned detection of obstacles module comprises ultrasonic sensor, filtering circuit, operational amplification circuit and vision module; Wherein the signal output part of ultrasonic sensor is connected with the input end of filtering circuit; The output terminal of filtering circuit is connected with the input end of operational amplification circuit, and vision module and ultrasonic sensor, filtering circuit, operational amplification circuit walk abreast.
Above-mentioned robot controller includes action generation module and action memory module; The ultrasonic sensor that detects robot the place ahead obstacle information in real time in the detection of obstacles module and the signal output part of vision module are connected with the signal input part of action generation module; The action generation module is judged the state of robot the place ahead barrier; And cook up each joint action scheme that stands, be stored to the action memory module, and steering order is sent to actuator.
Above-mentioned action generation module comprises attitude discrimination module, numerical operation module and instruction generation module; Above-mentioned attitude discrimination module is the obstacle information in robot the place ahead of getting access to according to the detection of obstacles module; According to the variation tendency of speed, acceleration on X, Y, three directions of Z, transmission information is given the numerical operation module, and the numerical operation module is responsible for the movement locus in each joint of planning robot; Receive the signal that falls down to the ground in real time; Generate the action command of corresponding with it across obstacle through the instruction generation module, make the movement locus in each joint of different action phase, and change into the angle instruction and send the action memory module to.
Above-mentioned action memory module comprises action storage unit and data control circuit, and wherein data control circuit carries out the input-output operation of data to the action storage unit.
The utility model anthropomorphic dummy finds barrier in the process of walking; Adopt closed-loop control; Utilize ultrasonic sensor to detect robot the place ahead barrier in real time, judge the height of the place ahead barrier by vision module, the action generation module is cooked up each joint action scheme of lower limb; Be stored to action memory, being accomplished by action control module at last should action.The utility model is that the fine of the normal walking of robot replenished; The action effective coordination of planning has utilized each joint of the lower limb of robot; Be a kind of lower extremity movement planning system of natural, biped robot's across obstacle of stablizing, meeting the human motion characteristic, the lower extremity movement planning system of the utility model biped robot across obstacle has strengthened the adaptability of robot to complex environment.
Description of drawings
Fig. 1 is the theory diagram of the utility model;
Fig. 2 is the theory diagram of the utility model actuator;
Fig. 3 is the theory diagram of the utility model detection of obstacles module;
Fig. 4 is the theory diagram of the utility model action memory module;
Embodiment
Embodiment:
The theory diagram of the utility model is as shown in Figure 1; The lower extremity movement planning system of biped robot's across obstacle of the utility model; Include robot controller 1, actuator 2, each joint motor 3, detection of obstacles module 4; Wherein the signal output part of the detection of obstacles module 4 of detection machine people the place ahead situation is connected with the signal input part of robot controller 1; The control signal output ends of robot controller 1 is connected with the signal input part of actuator 2, and the signal output part of actuator 2 is connected with the signal input part of each joint motor 3 that drives each joint motions.
In the present embodiment; Above-mentioned actuator 2 comprises multi-joint controller 21, power driving circuit 22, photoelectric encoder 23 and comparator circuit 24; Wherein the control signal output ends of robot controller 1 is connected with the signal input part of multi-joint controller 21; The signal output part of multi-joint controller 21 is connected with the signal input part of power driving circuit 22; The signal output part of power driving circuit 22 is connected with the signal input part of each joint motor 3 that drives each joint motions; And the signal output part of photoelectric encoder 23 that detects the moving situation of each joint motor 3 is connected with the signal input part of comparator circuit 24, and the signal output part of comparator circuit 24 is connected with the signal input part of multi-joint controller 21.In the present embodiment, the said multi-joint controller 21 main movement instructions of being responsible for receiving action memory change, explain by the agreement of regulation, and the motion control arithmetic that combines to be solidificated in the joint control are accomplished the control to the joint of robot motor.Give driver sending controling instruction or PWM wave train in conjunction with control algolithm; The signal that feeds back through photoelectric encoder 23 senser elements such as grade is simultaneously done corresponding adjustment to steering order (perhaps PWM wave train) again, thereby each joint of robot is all reached or maximum expecting state near controller.
In the present embodiment, above-mentioned each joint motor 3 is a servomotor.
Above-mentioned detection of obstacles module 4 comprises ultrasonic sensor 41, filtering circuit 42, operational amplification circuit 43 and vision module 44; Wherein the signal output part of ultrasonic sensor 41 is connected with the input end of filtering circuit 42; The output terminal of filtering circuit 42 is connected with the input end of operational amplification circuit 43, and vision module 44 walks abreast with ultrasonic sensor 41, filtering circuit 42, operational amplification circuit 43.
In the present embodiment; Above-mentioned robot controller 1 includes action generation module 11 and action memory module 12; The ultrasonic sensor 41 that detects robot the place ahead obstacle information in real time in the detection of obstacles module 4 and the signal output part of vision module 44 are connected with the signal input part of action generation module 11; Action generation module 11 is judged the state of robot the place ahead barrier; And cook up each joint action scheme that stands, be stored to action memory module 12, and steering order is sent to actuator 2.
In the present embodiment; Above-mentioned action generation module 11 comprises attitude discrimination module, numerical operation module and instruction generation module, and above-mentioned attitude discrimination module is the obstacle information in robot the place ahead of getting access to according to the detection of obstacles module, according to the variation tendency of speed, acceleration on X, Y, three directions of Z; Transmission information is given the numerical operation module; The numerical operation module is responsible for the movement locus in each joint of planning robot, receives the signal that falls down to the ground in real time, generates the action command of corresponding with it across obstacle through the instruction generation module; Make the movement locus in each joint of different action phase, and change into angle instruction and send action memory module 12 to.
In the present embodiment, above-mentioned action memory module 12 comprises action storage unit 121 and data control circuit 122, and wherein 122 pairs of actions of data control circuit storage unit 121 is carried out the input-output operation of data.
In the present embodiment, the mode of motion of biped robot left side leg across obstacle carries out according to following process:
1) thigh of robot is rotated counterclockwise around hip joint, and the shank joint of staying with one's parents in order to make them happy turns clockwise, and thigh upwards lifts, and shank is to rear curved, and is equal with barrier up to the left foot point, and center of gravity is by skew to the right in the middle of two legs, the balance of maintenance health simultaneously.
2) left foot rotates counterclockwise around ankle-joint, makes sole parallel to the ground, and thigh continues to be rotated counterclockwise around hip joint, and thigh is upwards lifted, and left foot moves forward at the barrier top.
3) the shank joint of staying with one's parents in order to make them happy rotates counterclockwise, and left foot is moved forward, and strides across barrier.
4) thigh turns clockwise around hip joint, and the shank joint of staying with one's parents in order to make them happy is rotated counterclockwise, and left foot turns clockwise around ankle-joint, and left foot is landed.
In the present embodiment, the mode of motion of the right leg across obstacle of biped robot carries out according to following process:
1) the robot hip joint is along with move forward above the waist, and thigh is stayed with one's parents in order to make them happy the joint clockwise around moving certain angle, the centre of body weight reach.
2) the robot knee joint moves forward, and thigh rotates counterclockwise to being about in last on a line around hip joint, and the shank joint of staying with one's parents in order to make them happy clockwise rotates, and is higher than barrier until right crus of diaphragm.
3) knee joint of robot continues to move forward, and thigh continues to rotate counterclockwise around hip joint, shank, and ankle-joint moves along with knee joint is parallel forward with right crus of diaphragm.
4) thigh continues to rotate counterclockwise around hip joint, and thigh takes shank to and upwards lifts, and makes right crus of diaphragm stride across barrier.
5) the robot thigh clockwise rotates around hip joint, and the shank joint of staying with one's parents in order to make them happy rotates counterclockwise, and knee joint moves down, and the right crus of diaphragm palm lands.
Claims (4)
1. the lower extremity movement planning system of biped robot's across obstacle; It is characterized in that including robot controller (1), actuator (2), each joint motor (3), detection of obstacles module (4); Wherein the signal output part of the detection of obstacles module (4) of detection machine people the place ahead situation is connected with the signal input part of robot controller (1); The control signal output ends of robot controller (1) is connected with the signal input part of actuator (2), and the signal output part of actuator (2) is connected with the signal input part of each joint motor (3) that drives each joint motions.
2. the lower extremity movement planning system of biped robot's across obstacle according to claim 1; It is characterized in that above-mentioned actuator (2) comprises multi-joint controller (21), power driving circuit (22), photoelectric encoder (23) and comparator circuit (24); Wherein the control signal output ends of robot controller (1) is connected with the signal input part of multi-joint controller (21); The signal output part of multi-joint controller (21) is connected with the signal input part of power driving circuit (22); The signal output part of power driving circuit (22) is connected with the signal input part of each joint motor (3) that drives each joint motions; And the signal output part of photoelectric encoder (23) that detects the moving situation of each joint motor (3) is connected with the signal input part of comparator circuit (24), and the signal output part of comparator circuit (24) is connected with the signal input part of multi-joint controller (21).
3. the lower extremity movement planning system of biped robot's across obstacle according to claim 1 is characterized in that above-mentioned each joint motor (3) is a servomotor.
4. according to the lower extremity movement planning system of each described biped robot's across obstacle of claim 1 to 3; It is characterized in that above-mentioned detection of obstacles module (4) comprises ultrasonic sensor (41), filtering circuit (42), operational amplification circuit (43) and vision module (44); Wherein the signal output part of ultrasonic sensor (41) is connected with the input end of filtering circuit (42); The output terminal of filtering circuit (42) is connected with the input end of operational amplification circuit (43), and vision module (44) walks abreast with ultrasonic sensor (41), filtering circuit (42), operational amplification circuit (43).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 201120554659 CN202583882U (en) | 2011-12-27 | 2011-12-27 | Lower limb motion planning system for biped robot in obstacle crossing |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 201120554659 CN202583882U (en) | 2011-12-27 | 2011-12-27 | Lower limb motion planning system for biped robot in obstacle crossing |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN202583882U true CN202583882U (en) | 2012-12-05 |
Family
ID=47253274
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN 201120554659 Expired - Fee Related CN202583882U (en) | 2011-12-27 | 2011-12-27 | Lower limb motion planning system for biped robot in obstacle crossing |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN202583882U (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102541068A (en) * | 2011-12-27 | 2012-07-04 | 广东工业大学 | Lower limb motion planning system for biped robot in obstacle crossing |
-
2011
- 2011-12-27 CN CN 201120554659 patent/CN202583882U/en not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102541068A (en) * | 2011-12-27 | 2012-07-04 | 广东工业大学 | Lower limb motion planning system for biped robot in obstacle crossing |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN202264835U (en) | Motion planning system for biped robot | |
| CN101428657B (en) | Propel mechanism of underactuated biped walk robot | |
| Behnke | Online trajectory generation for omnidirectional biped walking | |
| CN100364728C (en) | Operation control device for leg-type mobile robot and operation control method and robot device | |
| CN101353064B (en) | Ground to wall transition wall gecko-intimating robot | |
| CN102541068A (en) | Lower limb motion planning system for biped robot in obstacle crossing | |
| CN109986579B (en) | Multi-mode motion primate-imitating robot | |
| Al-Shuka et al. | Modeling, stability and walking pattern generators of biped robots: a review | |
| JP2001150370A (en) | Leg-type moving robot and operation control method for the same | |
| CN101941479A (en) | Spider robot | |
| CN102431604A (en) | Humanoid robot with function of interchanging double-foot walking with wheeled moving | |
| CN109760761A (en) | A kind of quadruped robot motion control method based on bionic principle and intuition | |
| CN102372042A (en) | Motion planning system for biped robot | |
| CN105599822A (en) | Under-actuated biped walking robot based on flexible drivers | |
| Hong et al. | Development of a tele-operated rescue robot for a disaster response | |
| CN114384918A (en) | Diagonal gait compliance control method of four-footed robot based on drop foot point adjustment | |
| Liao et al. | Energy efficient swing leg trajectory planning for quadruped robots walking on rough terrain | |
| CN202583882U (en) | Lower limb motion planning system for biped robot in obstacle crossing | |
| Doan et al. | A new approach for development of quadruped robot based on biological concepts | |
| CN206123679U (en) | Humanoid robot is out of shape to high trafficability characteristic | |
| Cherouvim et al. | Control of hopping speed and height over unknown rough terrain using a single actuator | |
| CN100497073C (en) | Positive and passive movement combined elastic mechanical legs | |
| JP4770990B2 (en) | Legged mobile robot and control method thereof | |
| JP4587699B2 (en) | Robot apparatus and control method thereof | |
| Li et al. | Design of a hexapod robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C17 | Cessation of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20121205 Termination date: 20131227 |