CN106584460A - Vibration suppression method in walking of humanoid robot - Google Patents

Vibration suppression method in walking of humanoid robot Download PDF

Info

Publication number
CN106584460A
CN106584460A CN201611168615.0A CN201611168615A CN106584460A CN 106584460 A CN106584460 A CN 106584460A CN 201611168615 A CN201611168615 A CN 201611168615A CN 106584460 A CN106584460 A CN 106584460A
Authority
CN
China
Prior art keywords
zmp
walking
input
vibration
humanoid robot
Prior art date
Application number
CN201611168615.0A
Other languages
Chinese (zh)
Inventor
易江
朱秋国
熊蓉
吴俊�
Original Assignee
浙江大学
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 浙江大学 filed Critical 浙江大学
Priority to CN201611168615.0A priority Critical patent/CN106584460A/en
Publication of CN106584460A publication Critical patent/CN106584460A/en

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/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control

Abstract

The invention a vibration suppression method in walking of a humanoid robot based on an input shaper. The method comprises the following steps: firstly collecting ZMP position step response signals by using a pelma six-dimensional force/moment sensor; then building a model of a process from a ZMP reference value to a ZMP practical value according to the ZMP position step response signals, constructing the input shaper according to the obtained model, and calculating time advance of a reference ZMP track according to the obtained model; and finally putting the obtained input shaper and the time advance link in a reference ZMP track generator, and applying the reference ZMP track generator to walking of the humanoid robot. Through the vibration suppression method, the vibration caused by a non-rigid connection rod system in walking is suppressed in a feedforward manner by modifying the reference ZMP track sent to a centroid track generator, so that the walking is more stable; compared with a method for suppressing vibration by feedback, the method can suppress the vibration after the vibration occurs and is free of risk of oscillation caused by overhigh closed-loop gain.

Description

A kind of vibration suppressing method in Humanoid Robot Based on Walking
Technical field
The present invention relates to the vibration suppressing method in robotics, more particularly to a kind of Humanoid Robot Based on Walking.
Background technology
Due to there is non-rigid characteristic in the push and pull system of anthropomorphic robot, anthropomorphic robot is in the process of walking often There is vibration.When vibrating excessive, the position of point of zero moment (Zero Momentum Point, hereinafter referred to as ZMP) may reach To the edge of support polygon, the danger toppled over is brought.Therefore, it is necessary to be brought by push and pull system is non-rigid in suppressing to walk Vibration.
Suppress the vibration in Humanoid Robot Based on Walking, mainly there is following two classes method at present.The first kind is to improve robot The rigidity of push and pull system.It is general by improvement Design of Mechanical Structure or next from the higher driving means of performance and transmission mechanism Realize.The design level that this kind of method is limited to implementer and the hardware condition having, and general cost is high, or can bring The drawbacks of weight increases.Equations of The Second Kind is that vibration is considered as into additional disturbance, and by feedback control the suppression to disturbing is realized.It is this kind of Method only has occurred and that and walking stability being generated the effect of just can start after adverse effect, and suppression action in vibration Itself may bring new vibration.
The content of the invention
Present invention aims to the deficiencies in the prior art, there is provided the vibration suppression in a kind of Humanoid Robot Based on Walking Method.
The purpose of the present invention is achieved through the following technical solutions:A kind of anthropomorphic robot based on input forming device Vibration suppressing method in walking, comprises the following steps that:
(1) using vola six-dimensional force/torque sensor collection ZMP positions phase step response signals;
(2) ZMP reference values are modeled to the process of ZMP actual values according to ZMP phase step response signals;
(3) according to the model for obtaining, input forming device is constructed;
(4) according to the model for obtaining, the Timing Advance with reference to ZMP tracks is calculated;
(5) after the input forming device for obtaining and time advance link being placed in reference to ZMP track creators, it is applied to imitate The walking of robot people.
Further, the step (1) is specially:Robot both feet are made to land, while amplitude is bipod center distance four The reference ZMP step signals of/mono- left and right directions, or an amplitude is the ginseng of the fore-and-aft direction of bipod length a quarter Examine ZMP step signals to be input in the centroid trajectory maker controlled based on preview, produce corresponding or so or fore-and-aft direction Barycenter translational motion, is measured during this on left and right or fore-and-aft direction using the six-dimensional force/torque sensor installed in vola Actual ZMP change in location track.
Further, the step (2) is specially:If defeated by actual ZMP is input to reference to ZMP on left and right or fore-and-aft direction Transmission function G (s) of the complex domain form of the process for going out is
Wherein, s is the Laplace transform operator of complex domain, and ζ is damped coefficient, and ω is nothing Damping nature frequency of oscillation.
Using the input-output data measured in step (1), using least square method or analytic method, model parameter is asked for ω and ζ;
Further, the step (3) is specially:The digital filter form that construction is made up of two pulses is entered as Shape device, amplitude A of two pulses1And A2Respectively
Wherein parameter K is defined as:
And the moment t of two pulses1And t2Respectively:
Further, the step (4) is specially:Equation of the numerical methods of solving with regard to time t:
In t>Solution t=T when 00, then T0It is the Timing Advance with reference to the input of ZMP tracks, it is theoretical defeated under this lead Go out the integration minimum of ZMP tracks and the absolute value with reference to the error between ZMP tracks;
Further, the step (5) is specially:It is T by foregoing time span0Time advance link and defeated Enter former to be inserted into after the reference ZMP track creators of left and right or fore-and-aft direction, the modification after the two links Reference ZMP tracks be input in centroid trajectory maker, you can produce cause left and right or fore-and-aft direction vibration it is repressed Motion.
The invention has the beneficial effects as follows, the present invention is sent to the reference ZMP tracks of centroid trajectory maker by modification, front Inhibit in walking by the non-rigid vibration for bringing of push and pull system to feedback so that walking is more stable.Compared to modification machinery knot The method that structure suppresses vibration, this method does not need extra cost.Method compared to being vibrated by feedback inhibition, this method is existed Vibration is just suppressed before occurring, and without the excessive risk for causing to vibrate of closed loop gain.
Description of the drawings
Fig. 1 is that the anthropomorphic robot walking movement for having used this method generates overall control block diagram, the part of dotted line inframe For the vibration suppression feedforward controller that this method is introduced.
Fig. 2 be using this method before left and right directions ZMP reference locus and actual path, wherein dotted line be reference locus, Solid line is actual measurement track.
Fig. 3 is the ZMP positions phase step response signals collected using vola six-dimensional force/torque sensor, and wherein dotted line is The reference step signal of centroid trajectory maker is input to, solid line is practical measurement signals.
Fig. 4 be using this method after left and right directions ZMP reference locus and actual path, wherein dotted line be reference locus, Solid line is actual measurement track.
Specific embodiment
Vibration suppressing method in a kind of Humanoid Robot Based on Walking based on input forming device of the present invention, concrete steps are such as Under:
1st, using vola six-dimensional force/torque sensor collection ZMP positions phase step response signals:
Make robot both feet land, at the same by an amplitude for bipod center distance a quarter left and right directions reference ZMP step signals, or amplitude is input to for the reference ZMP step signals of the fore-and-aft direction of bipod length a quarter and is based on In the centroid trajectory maker of preview control, the barycenter translational motion of corresponding left and right or fore-and-aft direction is produced, using being arranged on Six-dimensional force/the torque sensor in vola measures during this left and right or the actual ZMP change in location track on fore-and-aft direction.
2nd, ZMP reference values are modeled to the process of ZMP actual values according to ZMP phase step response signals:
If by the transmission letter of the complex domain form that the process that actual ZMP is exported is input to reference to ZMP on left and right or fore-and-aft direction Counting G (s) is
Wherein, s is the Laplace transform operator of complex domain, and ζ is damped coefficient, and ω is nothing Damping nature frequency of oscillation.
Using the input-output data measured in step (1), using least square method or analytic method, model parameter is asked for ω and ζ.
3rd, according to the model for obtaining, input forming device is constructed:
The input forming device of the digital filter form that construction is made up of two pulses, amplitude A of two pulses1And A2Point It is not:
Wherein parameter K is defined as:
And the moment t of two pulses1And t2Respectively:
4th, according to the model for obtaining, the Timing Advance with reference to ZMP tracks is calculated:
Equation of the numerical methods of solving with regard to time t:
In t>Solution t=T when 00, then T0It is the Timing Advance with reference to the input of ZMP tracks, it is theoretical defeated under this lead Go out the integration minimum of ZMP tracks and the absolute value with reference to the error between ZMP tracks.
5th, after the input forming device for obtaining and time advance link being placed in reference to ZMP track creators, it is applied to imitate The walking of robot people:
It is T by foregoing time span0Time advance link and input forming device be inserted into left and right or front and back To reference ZMP track creators after, the reference ZMP tracks changed after the two links are input to centroid trajectory In maker, you can produce the repressed motion of vibration for causing left and right or fore-and-aft direction.
The present invention is further expalined by the following examples.With in the method walking actual to anthropomorphic robot Vibration is suppressed, and experimental data is provided by Zhejiang University.Fig. 2 be using this method before robot ambulation experiment in right and left To ZMP trajectory measurement values, it can be seen that vibration result in the fluctuation of ZMP positions, have impact on the stability of walking.Fig. 3 It is to be operated by step (1), the left and right directions ZMP positions phase step response signals for collecting.As described in step (2), thus believe Number model parameter is recognized, obtain ω=11.0966rads-1, ζ=0.2166.And then as described in step (3), try to achieve Two pulse amplitude A of input forming device1=0.6676, A2=0.3324, corresponding time t1=0, t2=0.29s.While root According to step (4), try to achieve ZMP reference locus and shift to an earlier date duration T0=0.1334s.Time advance link and input forming device are pressed into step (5) it is described to be applied in robot control system, ZMP trajectory measurements value such as Fig. 4 institutes of left and right directions in the walking experiment for obtaining Show, it can be seen that vibration has obtained significant suppression.

Claims (6)

1. a kind of vibration suppressing method in Humanoid Robot Based on Walking based on input forming device, it is characterised in that concrete steps It is as follows:
(1) using vola six-dimensional force/torque sensor collection ZMP positions phase step response signals.
(2) ZMP reference values are modeled to the process of ZMP actual values according to ZMP phase step response signals.
(3) model obtained according to step 2, constructs input forming device.
(4) model obtained according to step 2, calculates the Timing Advance with reference to ZMP tracks.
(5) Timing Advance that the input forming device for obtaining step 3 and step 4 are obtained be placed in reference to ZMP track creators it Afterwards, it is applied to the walking of anthropomorphic robot.
2. according to claim 1 based on the vibration suppressing method in the Humanoid Robot Based on Walking of input forming device, its feature It is that the step (1) is specially:Robot both feet are made to land, while being bipod center distance a quarter by an amplitude Left and right directions reference ZMP step signals, or amplitude is the reference ZMP ranks of the fore-and-aft direction of bipod length a quarter Jump signal input produces the barycenter translation of corresponding left and right or fore-and-aft direction in the centroid trajectory maker based on preview control Motion, using the six-dimensional force/torque sensor installed in vola actual ZMP on left and right or fore-and-aft direction is measured during this Change in location track.
3. according to claim 1 based on the vibration suppressing method in the Humanoid Robot Based on Walking of input forming device, its feature It is that the step (2) is specially:If answering by the process that actual ZMP outputs are input to reference to ZMP on left and right or fore-and-aft direction Transmission function G (s) of domain form is:
Wherein, s is the Laplace transform operator of complex domain, and ζ is damped coefficient, and ω is undamped Natural frequency of oscillation
Using the input-output data measured in step (1), using least square method or analytic method, ask for model parameter ω and ζ。
4. according to claim 1 based on the vibration suppressing method in the Humanoid Robot Based on Walking of input forming device, its feature It is that the step (3) is specially:The input forming device of the digital filter form that construction is made up of two pulses, two arteries and veins Amplitude A of punching1And A2Respectively:
A 1 = 1 1 + K A 2 = K 1 + K
Wherein parameter K is defined as:
K = e - ζ π / 1 - ζ 2 ;
And the moment t of two pulses1And t2Respectively:
t 1 = 0 t 2 = π ω 1 - ζ 2 .
5. according to claim 1 based on the vibration suppressing method in the Humanoid Robot Based on Walking of input forming device, its feature It is that the step (4) is specially:Equation of the numerical methods of solving with regard to time t:
1 1 - ζ 2 e - ζ ω t s i n ( ω 1 - ζ 2 t + cos - 1 ζ ) = 1 - K 2
In t>Solution t=T when 00, then T0It is the Timing Advance with reference to the input of ZMP tracks, under this lead, theory output ZMP tracks and the integration minimum of the absolute value with reference to the error between ZMP tracks.
6. according to claim 1 based on the vibration suppressing method in the Humanoid Robot Based on Walking of input forming device, its feature It is that the step (5) is specially:It is T by foregoing time span0Time advance link and input forming device insertion To after the reference ZMP track creators of left and right or fore-and-aft direction, the reference ZMP tracks changed after the two links In being input to centroid trajectory maker, you can produce the repressed motion of vibration for causing left and right or fore-and-aft direction.
CN201611168615.0A 2016-12-16 2016-12-16 Vibration suppression method in walking of humanoid robot CN106584460A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611168615.0A CN106584460A (en) 2016-12-16 2016-12-16 Vibration suppression method in walking of humanoid robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611168615.0A CN106584460A (en) 2016-12-16 2016-12-16 Vibration suppression method in walking of humanoid robot

Publications (1)

Publication Number Publication Date
CN106584460A true CN106584460A (en) 2017-04-26

Family

ID=58600925

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611168615.0A CN106584460A (en) 2016-12-16 2016-12-16 Vibration suppression method in walking of humanoid robot

Country Status (1)

Country Link
CN (1) CN106584460A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107738273A (en) * 2017-10-16 2018-02-27 华南理工大学 A kind of joint of robot end residual oscillation suppressing method based on input shaper
CN108549237A (en) * 2018-05-16 2018-09-18 华南理工大学 Preview based on depth enhancing study controls humanoid robot gait's planing method
WO2021003986A1 (en) * 2019-07-11 2021-01-14 北京理工大学 Foot force and moment following control method for bipedal robot

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05305586A (en) * 1992-04-30 1993-11-19 Honda Motor Co Ltd Walking control device for leg type mobile robot
US5432417A (en) * 1992-04-30 1995-07-11 Honda Giken Kogyo Kabushiki Kaisha Locomotion control system for legged mobile robot
WO2007046568A1 (en) * 2005-10-19 2007-04-26 Korea Institute Of Science And Technology A method for controlling the walk of humanoid robot
CN101667026A (en) * 2008-09-04 2010-03-10 三星电子株式会社 Robot and method of controlling the same
CN103042525A (en) * 2013-01-22 2013-04-17 北京理工大学 Method for determining anti-disturbance capacity of humanoid robot
CN104238360A (en) * 2014-09-03 2014-12-24 浙江大学 Method for obtaining Zc parameter of humanoid robot table-trolley model
CN106041884A (en) * 2016-05-19 2016-10-26 成都润惠科技有限公司 Balance controlling method used for heavy-load exoskeleton system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05305586A (en) * 1992-04-30 1993-11-19 Honda Motor Co Ltd Walking control device for leg type mobile robot
US5432417A (en) * 1992-04-30 1995-07-11 Honda Giken Kogyo Kabushiki Kaisha Locomotion control system for legged mobile robot
WO2007046568A1 (en) * 2005-10-19 2007-04-26 Korea Institute Of Science And Technology A method for controlling the walk of humanoid robot
CN101667026A (en) * 2008-09-04 2010-03-10 三星电子株式会社 Robot and method of controlling the same
CN103042525A (en) * 2013-01-22 2013-04-17 北京理工大学 Method for determining anti-disturbance capacity of humanoid robot
CN104238360A (en) * 2014-09-03 2014-12-24 浙江大学 Method for obtaining Zc parameter of humanoid robot table-trolley model
CN106041884A (en) * 2016-05-19 2016-10-26 成都润惠科技有限公司 Balance controlling method used for heavy-load exoskeleton system

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
YI J等: "《Vibration suppression based on input shaping for biped walking》", 《IEEE-RAS INTERNATIONAL CONFERENCE ON HUMANOID ROBOTS. PISCATAWAY, USA: IEEE,2016》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107738273A (en) * 2017-10-16 2018-02-27 华南理工大学 A kind of joint of robot end residual oscillation suppressing method based on input shaper
CN108549237A (en) * 2018-05-16 2018-09-18 华南理工大学 Preview based on depth enhancing study controls humanoid robot gait's planing method
CN108549237B (en) * 2018-05-16 2020-04-28 华南理工大学 Preset control humanoid robot gait planning method based on deep reinforcement learning
WO2021003986A1 (en) * 2019-07-11 2021-01-14 北京理工大学 Foot force and moment following control method for bipedal robot

Similar Documents

Publication Publication Date Title
Yun et al. Robust disturbance observer for two-inertia system
Takenaka et al. Real time motion generation and control for biped robot-1 st report: Walking gait pattern generation
Yun et al. Design of a disturbance observer for a two-link manipulator with flexible joints
CN104723340B (en) Based on the impedance adjustment connecting and damping the flexible joint mechanical arm configured
DE69636230T2 (en) ROBOT CONTROLLER
Kajita et al. A hop towards running humanoid biped
JP4531520B2 (en) Control device for legged mobile robot
US7496428B2 (en) Gait producing device for leg type movable robot
Abbeel et al. Autonomous autorotation of an RC helicopter
TWI459162B (en) Motor control unit
Ugurlu et al. Dynamic trot-walking with the hydraulic quadruped robot—HyQ: Analytical trajectory generation and active compliance control
DE10247347B4 (en) System and method for measuring the characteristic of an engine with a torque controller designed by the μ-synthesis method
Kajita et al. Running pattern generation for a humanoid robot
US8005573B2 (en) Control device for legged mobile robot
ES2248709T3 (en) Aircraft with electric flight controls, provided with a susceptible fuselage to deform and vibrate.
US7366587B2 (en) Legged mobile robot
US20060186845A1 (en) Servo controller
US20030184251A1 (en) Method for controlling electric motor and apparatus for controlling the same
Ono et al. Self-excited walking of a biped mechanism
US7902785B2 (en) Method and device for guiding the movement of a moveable machine element of a machine
WO2011067976A1 (en) Control device for power device
Khorashadizadeh et al. Robust task-space control of robot manipulators using Legendre polynomials for uncertainty estimation
US20090187275A1 (en) Legged Robot and Control Method Thereof
DE60313952T2 (en) CONTROL FOR MOBILE ROBOT WITH LEGS
KR101674282B1 (en) Trajectory control device for articulated robot, and control method

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
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20170426

WD01 Invention patent application deemed withdrawn after publication