Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics...
Transcript of Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics...
![Page 1: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/1.jpg)
Robot ControlBRUNO SICILIANO
www.prisma.unina.it
![Page 2: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/2.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Motion control Indirect force control Direct force control Interaction control using vision and force Experiments
OutlineRobot Control 2/56
![Page 3: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/3.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
B. Siciliano, L. Sciavicco, L. Villani, G. Oriolo, Robotics: Modelling, Planning and Control, Springer, London, 2009, DOI 10.1007/978-1-4471-0449-0 Chapter 8 ─ Motion Control Chapter 9 ─ Force Control Chapter 10 ─ Visual Control
MOOC Robotics Foundations – Robot ControlComing up soon … https://youtu.be/JwfRk-U3aPw
The TextbookRobot Modelling 3/56
![Page 4: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/4.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
B. Siciliano, O. Khatib, Springer Handbook of Robotics 2nd Edition, Springer, Heidelberg, 2016, DOI 10.1007/978-3-319-32552-1 Chapter 8 ─ Motion Control Chapter 9 ─ Force Control Chapter 34 ─ Visual Servoing
The HandbookRobot Modelling 4/56
![Page 5: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/5.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Joint space control Task references transformed into joint references Redundancy resolution at kinematic level
Motion ControlRobot Control 5/56
![Page 6: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/6.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Task space control Control directly in task (operational) space Redundancy resolution at dynamic level
Motion Control2Robot Control 6/56
![Page 7: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/7.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Tracking control Dynamic model-based compensation Euler angles Angle/axis Quaternion Computational issues Redundancy resolution
Regulation Static model-based compensation Orientation errors
Motion Control3Robot Control 7/56
![Page 8: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/8.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Inverse dynamics
Position control
Orientation control
Dynamic Model-Based CompensationRobot Control 8/56
Euler anglesAngle/axisQuaternion
![Page 9: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/9.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Orientation error:
Resolved angular acceleration
Error dynamics
Euler AnglesRobot Control 9/56
representation singularities (!)
![Page 10: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/10.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Orientation error:
Resolved angular acceleration
Error dynamics
Alternative Euler AnglesRobot Control 10/56
choose so that is nonsingular (!)
![Page 11: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/11.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Orientation error:
Angle/AxisRobot Control 11/56
angle axisRepresentation
Classical angle/axis
Quaternion
Rodrigues parameters
Simple rotation
![Page 12: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/12.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Angle/axis error:
Resolved angular acceleration
Error dynamics
Angle/AxisRobot Control 12/56
![Page 13: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/13.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Simpler choice:
Error dynamics
Stability via Lyapunov argument
Angle/AxisRobot Control 13/56
![Page 14: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/14.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Orientation error:
Resolved angular acceleration
Error dynamics
Stability via Lyapunov argument
QuaternionRobot Control 14/56
![Page 15: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/15.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Number of floating-point operations and function calls
Computational IssuesRobot Control 15/56
Resolved acceleration Trajectory generationOrientation error Flops Funcs Flops FuncsClassical Euler angles 68 8 52 8Alternative Euler angles 136 8 0 0Angle/axis 55 0 0 0Quaternion 60 1 21 1
![Page 16: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/16.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Comparison
Computational IssuesRobot Control 16/56
Resolved acceleration Trajectory generationOrientation error Flops Funcs Flops FuncsClassical Euler angles 68 8 52 8Alternative Euler angles 136 8 0 0Angle/axis 55 0 0 0Quaternion 60 1 21 1
![Page 17: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/17.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Null-space motion
Stability via Lyapunov argument
Redundancy ResolutionRobot Control 17/56
dynamically consistentpseudo-inverse
![Page 18: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/18.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Inverse dynamics control with redundancy resolution
Redundancy ResolutionRobot Control 18/56
![Page 19: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/19.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
PD control with gravity compensation
Position control
Orientation control
Static Model-Based CompensationRobot Control 19/56
Euler anglesAngle/axisQuaternion
![Page 20: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/20.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Euler angles
Alternative Euler angles
Angle/axis
Quaternion
For all … stability via Lyapunov arguments
Orientation ErrorsRobot Control 20/56
![Page 21: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/21.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Motion control vs. force control Object manipulation or surface operation requires control of interaction between robot
manipulator and environment Use of purely motion control strategy is candidate to fail (task planning accuracy) Control of contact force (compliant behaviour) Use of force/torque sensor (interfaced with robot control unit)
Indirect vs. direct force control Indirect force control: force control via motion control (w/out explicit closure of force
feedback loop) Direct force control: force controlled to desired value (w/ closure of force feedback loop)
Constrained MotionRobot Control 21/56
![Page 22: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/22.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Compliance control Active compliance Experiments
Impedance control Active impedance Inner motion control Three-DOF impedance control Experiments Six-DOF impedance control Experiments
Indirect Force ControlRobot Control 22/56
![Page 23: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/23.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Active vs. passive compliance
At steady state (position/force)
Active ComplianceRobot Control 23/56
![Page 24: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/24.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Set-up COMAU Smart 3-S robot Open control architecture
PD control with gravitycompensation Large proportional gains Small proportional gains
ExperimentsRobot Control 24/56
![Page 25: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/25.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Programmable mass-damping-stiffness at the end-effector
Active ImpedanceRobot Control 25/56
force/torque sensor
![Page 26: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/26.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Impedance control Force/torque measurements
Active ImpedanceRobot Control 26/56
![Page 27: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/27.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Compliant frame between desired and end-effector frame Enhanced disturbance rejection
Inner Motion ControlRobot Control 27/56
![Page 28: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/28.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Translational impedance
Linear acceleration (inner motion loop)
Inner Motion ControlRobot Control 28/56
![Page 29: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/29.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
ATI force/torque sensor 3-DOF impedance control
Effects of mass, damping and stiffness
Contact with unknown surface
ExperimentsRobot Control 29/56
![Page 30: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/30.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Rotational impedance Euler angles
Infinitesimal orientation displacement
Angular acceleration (inner motion loop)
Six-DOF Impedance ControlRobot Control 30/56
task geometric inconsistency
![Page 31: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/31.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Rotational impedance Alternative Euler angles
Infinitesimal orientation displacement
Angular acceleration (inner motion loop)
Six-DOF Impedance ControlRobot Control 31/56
task geometric consistency(XYZ Euler angles + diagonal stiffness)
![Page 32: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/32.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Rotational impedance Angle/axis
Infinitesimal orientation displacement
Angular acceleration (inner motion loop)
Six-DOF Impedance ControlRobot Control 32/56
task geometric consistency
![Page 33: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/33.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Rotational impedance Quaternion
Infinitesimal orientation displacement
Angular acceleration (inner motion loop)
Six-DOF Impedance ControlRobot Control 33/56
task geometric consistency
![Page 34: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/34.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
6-DOF impedance control Accommodation of both force
and moment Operational space approach
(Euler angles) Geometrically consistent
approach
ExperimentsRobot Control 34/56
![Page 35: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/35.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Regulation of force and moment to desired values
PI control
At steady state
Static Model-Based CompensationRobot Control 35/56
![Page 36: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/36.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Force and moment control with inner motion control loop Linear and angular accelerations
Dynamic Model-Based CompensationRobot Control 36/56
![Page 37: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/37.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Force control Regulation to zero force Inner position vs. velocity
control loop
ExperimentsRobot Control 37/56
![Page 38: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/38.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Force and motion control Regulation of force but loss of motion control
Recover motion control along unconstrained directions while ensuring force control along constrained directions
Force/Motion ControlRobot Control 38/56
Parallel control strategy
![Page 39: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/39.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
PD motion control with gravity compensation + force control
At steady state
Force/Motion ControlRobot Control 39/56
![Page 40: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/40.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Parallel force/position control Linear acceleration
Force and Position ControlRobot Control 40/56
![Page 41: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/41.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Force/position control with full parallel composition Linear acceleration
Force and Position ControlRobot Control 41/56
![Page 42: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/42.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Parallel force/position control Regulation to zero force with
position tracking PD+ position control with PI
force control
ExperimentsRobot Control 42/56
![Page 43: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/43.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Moment/orientation control with full parallel composition Linear acceleration
Moment and Orientation ControlRobot Control 43/56
![Page 44: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/44.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Tracking of time-varying force Full parallel composition
Tracking if exactly known
Force TrackingRobot Control 44/56
![Page 45: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/45.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Contact stiffness adaptation ( )
Force TrackingRobot Control 45/56Force Control > Direct Force Control > Force/Motion Control 45/65
![Page 46: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/46.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Extension to dual-robot system (loose cooperation) Typical peg-in-hole assembly
task Robot holding the hole
controlled as 6-DOF impedance
Robot holding the peg programmed in PDL-2
Accommodation of misalignment and overshoot
Further ExperimentsRobot Control 46/56
![Page 47: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/47.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Tight cooperation Two arms tightly grasping a
rigid object Control of the object position Control of the internal forces
Further ExperimentsRobot Control 47/56
![Page 48: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/48.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Dual-arm impedance control
Further ExperimentsRobot Control 48/56
absolute & relative impedance absolute impedance human-object interaction
![Page 49: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/49.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Human−robot interaction
Further ExperimentsRobot Control 49/56
null-space impedance control variable impedance control safe efficient pHRI
![Page 50: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/50.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Set-up @ DLR, Germany KUKA robot with force sensor
and camera embedded in the gripper
Integration of vision and force Visual feedback in gross
motion Force feedback in fine motion
Further ExperimentsRobot Control 50/56
![Page 51: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/51.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Problem Control interaction of a robot manipulator with a rigid object of
known geometry but unknown position and orientation
Solution When robot is far from object
Position-based visual servoing is adopted The relative pose of the robot with respect to the object is estimated recursively using only
vision When robot is in contact with object
Any kind of interaction control strategy can be adopted (impedance control, parallel force/position control)
The relative pose of the robot with respect to the object is estimated recursively using vision, force and joint position measurements
ExtensionRobot Control 51/56
![Page 52: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/52.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Position-based visual servoing
Visual Impedance ControlRobot Control 52/56
Force feedback
Impedance
impedance
![Page 53: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/53.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
Pose estimation errors
ExperimentsRobot Control 53/56
vision vision & force
X
![Page 54: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/54.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
F. Caccavale, C. Natale, B. Siciliano, L. Villani, "Resolved-acceleration control of robot manipulators: A critical review with experiments", Robotica, 16, 565–573, 1998
F. Caccavale, C. Natale, B. Siciliano, L. Villani, "Six-DOF impedance control basedon angle/axis representations", IEEE Transactions on Robotics and Automation, 15, 289–300, 1999
F. Caccavale, C. Natale, B. Siciliano, L. Villani, "Achieving a cooperative behaviour in a dual-arm robot system via a modular control structure", Journal of RoboticSystems, 18, 691–700, 2001
F. Caccavale, C. Natale, B. Siciliano, L. Villani, "Integration for the next generation: Embedding force control into industrial robots", IEEE Robotics and Automation Magazine, 12(3), 53–64, 2005
F. Caccavale, B. Siciliano, L. Villani, "Robot impedance control with nondiagonalstiffness", IEEE Transactions on Automatic Control, 44, 1943–1946, 1999
Additional ReferencesRobot Control 54/56
![Page 55: Robot Control - project.inria.fr · Robot Control. 7/56. GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018 Inverse](https://reader030.fdocuments.us/reader030/viewer/2022041011/5ebac8e05ed94e65ea582a39/html5/thumbnails/55.jpg)
GdR Robotics Winter School: Robotics Principia Inria Sophia Antipolis – Méditérranée, France • 22 January 2018
S. Chiaverini, L. Sciavicco, "The parallel approach to force/position control of roboticmanipulators", IEEE Transactions on Robotics and Automation, 9, 361–373, 1993
S. Chiaverini, B. Siciliano, L. Villani, "Force/position regulation of compliant robot manipulators", IEEE Transactions on Automatic Control, 39, 647–652, 1994
S. Chiaverini, B. Siciliano, L. Villani, "A survey of robot force control schemes with experimental comparison", IEEE/ASME Transactions on Mechatronics, 4, 273–285, 1999
V. Lippiello, B. Siciliano, L. Villani, "A position-based visual impedance control for robot manipulators", 2007 IEEE Int. Conf. on Robotics and Automation, Rome, I
C. Natale, Interaction Control of Robot Manipulators. Six-degrees-of-freedom Tasks, Springer, Heidelberg, D, 2003
B. Siciliano, L. Villani, Robot Force Control, Kluwer, Boston, MA, 1999
Additional References2Robot Control 55/56