Optimization-based control for dual-arm manipulation

Size: px
Start display at page:

Download "Optimization-based control for dual-arm manipulation"

Transcription

1 Optimization-based control for dual-arm manipulation Yuquan Wang, Francisco Viña, Yiannis Karayiannidis, Christian Smith and Petter Ögren KTH, Center for Autonomous Systems (CAS) June 5, 2014 Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

2 Background Intuitive examples Background: Why constraint-based programming? Problem: Candidate solution: Trajectory planing Pan&brush trajectories e(t) Joint trajectories q(t) Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

3 Background Intuitive examples Background: Why constraint-based programming? Problem: Candidate solution: Trajectory planing Pan&brush trajectories e(t) Joint trajectories q(t) Drawbacks: Not reactive Hard to extend Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

4 Background Intuitive examples Background: Why constraint-based programming? Problem: Candidate solution: Trajectory planing Pan&brush trajectories e(t) Joint trajectories q(t) Drawbacks: Not reactive Hard to extend Alternative: Constraint-based programming Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

5 Background Intuitive examples How to use constraint-based programming? Example: Specifing constraints: Combining constraints. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

6 Background Intuitive examples How to use constraint-based programming? Example: Specifing constraints: Relative position Brush orientation Contact force Obstacle avoidance Singularity avoidance Combining constraints. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

7 Background Intuitive examples Build a monster from something simple Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

8 Background Intuitive examples Build a monster from something simple Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

9 Background Earlier works Seminal earlier works in constraint-based programming Additional tasks (Seraji 1989) User defined objective functions (Peng and Adachi 1993) Stack of Tasks (Mansard and Chaumette 2007) itasc (De Schutter 2007) Sub-tasks (Tatlicioglu 2008) Prioritizing linear equality and inequality systems (Kanoun 2009) Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

10 Dual arm manipulation Contributions Sample task Dual arm manipulation using constraint based programming Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

11 Contributions Theoretical improvements Our formulation of constraint-based programming Quadratic optimization problem: 2014 IFAC: Dual arm manipulation using constraint-based programming Syroco: A multi objective control approach to online dual arm manipulation. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

12 Contributions Theoretical improvements Our formulation of constraint-based programming Quadratic optimization problem: min u ḟ j (q(t), u, t) + u T Qu, j I matrix. Q is a diagonal positive definite Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

13 Contributions Theoretical improvements Our formulation of constraint-based programming Quadratic optimization problem: min u ḟ j (q(t), u, t) + u T Qu, j I (s.t.) ḟ m (q, u, t) b m, m I ie, where b m, b n are positive scalars and Q is a diagonal positive definite matrix. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

14 Contributions Theoretical improvements Our formulation of constraint-based programming Quadratic optimization problem: min u ḟ j (q(t), u, t) + u T Qu, j I (s.t.) ḟ m (q, u, t) b m, m I ie, ḟ n (q, u, t) = b n, n I e, where b m, b n are positive scalars and Q is a diagonal positive definite matrix. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

15 Contributions Theoretical improvements Explicitly parameterize the convergence of each constraint: ḟ m (q, t) b m, m I ie, ḟ n (q, t) = b n, n I e, Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

16 Contributions Theoretical improvements Explicitly parameterize the convergence of each constraint: ḟ m (q, t) k m e m, m I ie, ḟ n (q, t) = k n e n, n I e, Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

17 Contributions Theoretical improvements Explicitly parameterize the convergence of each constraint: ḟ m (q, t) k m (f m (q, t) b m ), m I ie, ḟ n (q, t) = k n (f n (q, t) b n ), n I e, Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

18 Contributions Theoretical improvements Time-forward terms: ḟ m (q, t) k m (f m (q, t) b m ), m I ie, ḟ n (q, t) = k n (f n (q, t) b n ), n I e, Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

19 Contributions Theoretical improvements Time-forward terms: f m (q, t) q q f n (q, t) q q k m (f m (q, t) b m ) fm(q,t) t, m I ie, = k n (f n (q, t) b n ) fn(q,t) t, n I e, Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

20 Contributions Theoretical improvements Prioritizing the constaints: min u ḟ j (q(t), u, t) + u T Qu, j I (s.t.) ḟ m (q, u, t) k m (f m (q, t) b m ), m I ie, ḟ n (q, u, t) = k n (f n (q, t) b n ), n I e, where k m, b m are positive scalars and Q is a diagonal positive definite matrix. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

21 Contributions Theoretical improvements Prioritizing the constaints: min u ḟ j (q(t), u, t) + u T Qu+µ T W µ, j I (s.t.) ḟ m (q, u, t)+µ m k m (f m (q, t) b m ), m I ie, ḟ n (q, u, t)+µ n = k n (f n (q, t) b n ), n I e, where k m, b m are positive scalars and Q, W are diagonal positive definite matries. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

22 Contributions Theoretical improvements Our formulation of constraint-based programming Advantages: Compact formulation of a QP including equalities and inequalities. Time feed-forward terms. Parameterize the convergence rate. Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

23 Contributions Validation through examples Circular trajectory in the pan cleaning task Different convergence rate in simulation: Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

24 Contributions Validation through examples Circular trajectory in the pan cleaning task Experiment on a dual-arm robot: Tool relative to frying pan Z [m] X [m] Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

25 Contributions Validation through examples Circular trajectory in the pan cleaning task Experiment with contact force control: 0.03 Tool relative to frying pan Z [m] X [m] Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

26 Performance indices Contributions Validation through examples Deviation[m] Radians Measure Measure Force [N] x 10 3 Deviation Tool Orientation Left and right arm singularity measures Obstacle avoidance along z axis Force along pan normal direction and the reference is 8N 10 5 bound: 1*cos(pi/8) bound: bound: 0.1 Reference Time [s] (for all the rows) Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

27 Future work Human robot co-manipulation Human robot co-manipulation Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

28 Future work Human robot co-manipulation { r R } Human { h} {} r { r L } Robot Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

29 Acknowledgement Acknowledgement and questions Acknowledgement: Swedish Foundation for Strategic Research (SSF) Swedish Research Council (VR) EU FP7 project RoboHow.Cog Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

30 Acknowledgement Acknowledgement and questions Acknowledgement: Swedish Foundation for Strategic Research (SSF) Swedish Research Council (VR) EU FP7 project RoboHow.Cog Questions? Yuquan Wang (KTH, CVAP) ICRA 2014 June 5, / 16

Momentum-centric whole-body control and kino-dynamic motion generation for floating-base robots

Momentum-centric whole-body control and kino-dynamic motion generation for floating-base robots Momentum-centric whole-body control and kino-dynamic motion generation for floating-base robots Alexander Herzog The Movement Generation and Control Group (Ludovic Righetti) Conflicting tasks & constraints

More information

A Control Lyapunov Function Approach to Multiagent Coordination

A Control Lyapunov Function Approach to Multiagent Coordination IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL. 18, NO. 5, OCTOBER 2002 847 A Control Lyapunov Function Approach to Multiagent Coordination Petter Ögren, Magnus Egerstedt, Member, IEEE, and Xiaoming

More information

Predicting Slippage and Learning Manipulation Affordances through Gaussian Process Regression

Predicting Slippage and Learning Manipulation Affordances through Gaussian Process Regression 3 3th IEEE-RAS International Conference on Humanoid Robots (Humanoids). October 5-7, 3. Atlanta, GA Predicting Slippage and Learning Manipulation Affordances through Gaussian Process Regression Francisco

More information

Design and Control of Variable Stiffness Actuation Systems

Design and Control of Variable Stiffness Actuation Systems Design and Control of Variable Stiffness Actuation Systems Gianluca Palli, Claudio Melchiorri, Giovanni Berselli and Gabriele Vassura DEIS - DIEM - Università di Bologna LAR - Laboratory of Automation

More information

Scalable Sparsification for Efficient Decision Making Under Uncertainty in High Dimensional State Spaces

Scalable Sparsification for Efficient Decision Making Under Uncertainty in High Dimensional State Spaces Scalable Sparsification for Efficient Decision Making Under Uncertainty in High Dimensional State Spaces IROS 2017 KHEN ELIMELECH ROBOTICS AND AUTONOMOUS SYSTEMS PROGRAM VADIM INDELMAN DEPARTMENT OF AEROSPACE

More information

A new large projection operator for the redundancy framework

A new large projection operator for the redundancy framework 21 IEEE International Conference on Robotics and Automation Anchorage Convention District May 3-8, 21, Anchorage, Alaska, USA A new large projection operator for the redundancy framework Mohammed Marey

More information

Linear Algebra and Robot Modeling

Linear Algebra and Robot Modeling Linear Algebra and Robot Modeling Nathan Ratliff Abstract Linear algebra is fundamental to robot modeling, control, and optimization. This document reviews some of the basic kinematic equations and uses

More information

Example: RR Robot. Illustrate the column vector of the Jacobian in the space at the end-effector point.

Example: RR Robot. Illustrate the column vector of the Jacobian in the space at the end-effector point. Forward kinematics: X e = c 1 + c 12 Y e = s 1 + s 12 = s 1 s 12 c 1 + c 12, = s 12 c 12 Illustrate the column vector of the Jacobian in the space at the end-effector point. points in the direction perpendicular

More information

Edexcel GCE Further Pure Mathematics FP1 Advanced/Advanced Subsidiary

Edexcel GCE Further Pure Mathematics FP1 Advanced/Advanced Subsidiary Centre No. Candidate No. Surname Signature Paper Reference(s) 6667/01 Edexcel GCE Further Pure Mathematics FP1 Advanced/Advanced Subsidiary Wednesday 22 June 2011 Morning Time: 1 hour 30 minutes Materials

More information

Joint Position and Velocity Bounds in Discrete-Time Acceleration/Torque Control of Robot Manipulators

Joint Position and Velocity Bounds in Discrete-Time Acceleration/Torque Control of Robot Manipulators Joint Position and Velocity Bounds in Discrete-Time Acceleration/Torque Control of Robot Manipulators Andrea Del Prete To cite this version: Andrea Del Prete. Joint Position and Velocity Bounds in Discrete-Time

More information

EML5311 Lyapunov Stability & Robust Control Design

EML5311 Lyapunov Stability & Robust Control Design EML5311 Lyapunov Stability & Robust Control Design 1 Lyapunov Stability criterion In Robust control design of nonlinear uncertain systems, stability theory plays an important role in engineering systems.

More information

Robotics 2 Robots with kinematic redundancy

Robotics 2 Robots with kinematic redundancy Robotics 2 Robots with kinematic redundancy Prof. Alessandro De Luca Redundant robots! direct kinematics of the task r = f(q) f: Q! R joint space (dim Q = N) task space (dim R = M)! a robot is (kinematically)

More information

MCE/EEC 647/747: Robot Dynamics and Control. Lecture 12: Multivariable Control of Robotic Manipulators Part II

MCE/EEC 647/747: Robot Dynamics and Control. Lecture 12: Multivariable Control of Robotic Manipulators Part II MCE/EEC 647/747: Robot Dynamics and Control Lecture 12: Multivariable Control of Robotic Manipulators Part II Reading: SHV Ch.8 Mechanical Engineering Hanz Richter, PhD MCE647 p.1/14 Robust vs. Adaptive

More information

Robotics I. April 1, the motion starts and ends with zero Cartesian velocity and acceleration;

Robotics I. April 1, the motion starts and ends with zero Cartesian velocity and acceleration; Robotics I April, 6 Consider a planar R robot with links of length l = and l =.5. he end-effector should move smoothly from an initial point p in to a final point p fin in the robot workspace so that the

More information

Reconstructing Null-space Policies Subject to Dynamic Task Constraints in Redundant Manipulators

Reconstructing Null-space Policies Subject to Dynamic Task Constraints in Redundant Manipulators Reconstructing Null-space Policies Subject to Dynamic Task Constraints in Redundant Manipulators Matthew Howard Sethu Vijayakumar September, 7 Abstract We consider the problem of direct policy learning

More information

Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar

Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar Video 8.1 Vijay Kumar 1 Definitions State State equations Equilibrium 2 Stability Stable Unstable Neutrally (Critically) Stable 3 Stability Translate the origin to x e x(t) =0 is stable (Lyapunov stable)

More information

L03. PROBABILITY REVIEW II COVARIANCE PROJECTION. NA568 Mobile Robotics: Methods & Algorithms

L03. PROBABILITY REVIEW II COVARIANCE PROJECTION. NA568 Mobile Robotics: Methods & Algorithms L03. PROBABILITY REVIEW II COVARIANCE PROJECTION NA568 Mobile Robotics: Methods & Algorithms Today s Agenda State Representation and Uncertainty Multivariate Gaussian Covariance Projection Probabilistic

More information

Minimization of the rate of change in torques during motion and force control under discontinuous constraints

Minimization of the rate of change in torques during motion and force control under discontinuous constraints Minimization of the rate of change in torques during motion and force control under discontinuous constraints Yang Tan, Darwin Lau, Mingxing Liu, Philippe Bidaud, Vincent Padois To cite this version: Yang

More information

An Incremental Deployment Algorithm for Mobile Sensors

An Incremental Deployment Algorithm for Mobile Sensors 1 An Incremental Deployment Algorithm for Mobile Sensors Mohammad Emtiyaz Khan Department of Computer Science University of British Columbia Abstract In this report, we propose an incremental deployment

More information

Module 6 : Solving Ordinary Differential Equations - Initial Value Problems (ODE-IVPs) Section 3 : Analytical Solutions of Linear ODE-IVPs

Module 6 : Solving Ordinary Differential Equations - Initial Value Problems (ODE-IVPs) Section 3 : Analytical Solutions of Linear ODE-IVPs Module 6 : Solving Ordinary Differential Equations - Initial Value Problems (ODE-IVPs) Section 3 : Analytical Solutions of Linear ODE-IVPs 3 Analytical Solutions of Linear ODE-IVPs Before developing numerical

More information

Inverse differential kinematics Statics and force transformations

Inverse differential kinematics Statics and force transformations Robotics 1 Inverse differential kinematics Statics and force transformations Prof Alessandro De Luca Robotics 1 1 Inversion of differential kinematics! find the joint velocity vector that realizes a desired

More information

CS412: Lecture #17. Mridul Aanjaneya. March 19, 2015

CS412: Lecture #17. Mridul Aanjaneya. March 19, 2015 CS: Lecture #7 Mridul Aanjaneya March 9, 5 Solving linear systems of equations Consider a lower triangular matrix L: l l l L = l 3 l 3 l 33 l n l nn A procedure similar to that for upper triangular systems

More information

Mobile Manipulation: Force Control

Mobile Manipulation: Force Control 8803 - Mobile Manipulation: Force Control Mike Stilman Robotics & Intelligent Machines @ GT Georgia Institute of Technology Atlanta, GA 30332-0760 February 19, 2008 1 Force Control Strategies Logic Branching

More information

ROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino

ROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino ROBOTICS 01PEEQW Basilio Bona DAUIN Politecnico di Torino Kinematic Functions Kinematic functions Kinematics deals with the study of four functions(called kinematic functions or KFs) that mathematically

More information

Introduction to Machine Learning. Introduction to ML - TAU 2016/7 1

Introduction to Machine Learning. Introduction to ML - TAU 2016/7 1 Introduction to Machine Learning Introduction to ML - TAU 2016/7 1 Course Administration Lecturers: Amir Globerson (gamir@post.tau.ac.il) Yishay Mansour (Mansour@tau.ac.il) Teaching Assistance: Regev Schweiger

More information

Quadratic reformulation techniques for 0-1 quadratic programs

Quadratic reformulation techniques for 0-1 quadratic programs OSE SEMINAR 2014 Quadratic reformulation techniques for 0-1 quadratic programs Ray Pörn CENTER OF EXCELLENCE IN OPTIMIZATION AND SYSTEMS ENGINEERING ÅBO AKADEMI UNIVERSITY ÅBO NOVEMBER 14th 2014 2 Structure

More information

Lecture 8: Kinematics: Path and Trajectory Planning

Lecture 8: Kinematics: Path and Trajectory Planning Lecture 8: Kinematics: Path and Trajectory Planning Concept of Configuration Space c Anton Shiriaev. 5EL158: Lecture 8 p. 1/20 Lecture 8: Kinematics: Path and Trajectory Planning Concept of Configuration

More information

Robotics I. February 6, 2014

Robotics I. February 6, 2014 Robotics I February 6, 214 Exercise 1 A pan-tilt 1 camera sensor, such as the commercial webcams in Fig. 1, is mounted on the fixed base of a robot manipulator and is used for pointing at a (point-wise)

More information

RANGE CONTROL MPC APPROACH FOR TWO-DIMENSIONAL SYSTEM 1

RANGE CONTROL MPC APPROACH FOR TWO-DIMENSIONAL SYSTEM 1 RANGE CONTROL MPC APPROACH FOR TWO-DIMENSIONAL SYSTEM Jirka Roubal Vladimír Havlena Department of Control Engineering, Facult of Electrical Engineering, Czech Technical Universit in Prague Karlovo náměstí

More information

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J.

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J. Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik Robot Dynamics Dr.-Ing. John Nassour 25.1.218 J.Nassour 1 Introduction Dynamics concerns the motion of bodies Includes Kinematics

More information

Paper Reference. Further Pure Mathematics FP1 Advanced/Advanced Subsidiary. Wednesday 17 June 2009 Morning Time: 1 hour 30 minutes

Paper Reference. Further Pure Mathematics FP1 Advanced/Advanced Subsidiary. Wednesday 17 June 2009 Morning Time: 1 hour 30 minutes Centre No. Candidate No. Surname Signature Paper Reference(s) 6667/01 Edexcel GCE Further Pure Mathematics FP1 Advanced/Advanced Subsidiary Wednesday 17 June 2009 Morning Time: 1 hour 30 minutes Materials

More information

Statistical Visual-Dynamic Model for Hand-Eye Coordination

Statistical Visual-Dynamic Model for Hand-Eye Coordination The 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems October 18-22, 2010, Taipei, Taiwan Statistical Visual-Dynamic Model for Hand-Eye Coordination Daniel Beale, Pejman Iravani

More information

Toward Online Probabilistic Path Replanning

Toward Online Probabilistic Path Replanning Toward Online Probabilistic Path Replanning R. Philippsen 1 B. Jensen 2 R. Siegwart 3 1 LAAS-CNRS, France 2 Singleton Technology, Switzerland 3 ASL-EPFL, Switzerland Workshop on Autonomous Robot Motion,

More information

Control. CSC752: Autonomous Robotic Systems. Ubbo Visser. March 9, Department of Computer Science University of Miami

Control. CSC752: Autonomous Robotic Systems. Ubbo Visser. March 9, Department of Computer Science University of Miami Control CSC752: Autonomous Robotic Systems Ubbo Visser Department of Computer Science University of Miami March 9, 2017 Outline 1 Control system 2 Controller Images from http://en.wikipedia.org/wiki/feed-forward

More information

Smooth Path Generation Based on Bézier Curves for Autonomous Vehicles

Smooth Path Generation Based on Bézier Curves for Autonomous Vehicles Smooth Path Generation Based on Bézier Curves for Autonomous Vehicles Ji-wung Choi, Renwick E. Curry, Gabriel Hugh Elkaim Abstract In this paper we present two path planning algorithms based on Bézier

More information

Multi-Priority Cartesian Impedance Control

Multi-Priority Cartesian Impedance Control Multi-Priority Cartesian Impedance Control Robert Platt Jr. Computer Science and Artificial Intelligence Laboratory Massachusetts Institute of Technology rplatt@csail.mit.edu Muhammad Abdallah, Charles

More information

Enhancing a Model-Free Adaptive Controller through Evolutionary Computation

Enhancing a Model-Free Adaptive Controller through Evolutionary Computation Enhancing a Model-Free Adaptive Controller through Evolutionary Computation Anthony Clark, Philip McKinley, and Xiaobo Tan Michigan State University, East Lansing, USA Aquatic Robots Practical uses autonomous

More information

Force Tracking Impedance Control with Variable Target Stiffness

Force Tracking Impedance Control with Variable Target Stiffness Proceedings of the 17th World Congress The International Federation of Automatic Control Force Tracking Impedance Control with Variable Target Stiffness K. Lee and M. Buss Institute of Automatic Control

More information

A Unified Quadratic-Programming-Based Dynamical System Approach to Joint Torque Optimization of Physically Constrained Redundant Manipulators

A Unified Quadratic-Programming-Based Dynamical System Approach to Joint Torque Optimization of Physically Constrained Redundant Manipulators 16 IEEE TRANSACTIONS ON SYSTEMS, MAN, AND CYBERNETICS PART B: CYBERNETICS, VOL. 34, NO. 5, OCTOBER 004 A Unified Quadratic-Programg-Based Dynamical System Approach to Joint Torque Optimization of Physically

More information

MULTI-AGENT TRACKING OF A HIGH-DIMENSIONAL ACTIVE LEADER WITH SWITCHING TOPOLOGY

MULTI-AGENT TRACKING OF A HIGH-DIMENSIONAL ACTIVE LEADER WITH SWITCHING TOPOLOGY Jrl Syst Sci & Complexity (2009) 22: 722 731 MULTI-AGENT TRACKING OF A HIGH-DIMENSIONAL ACTIVE LEADER WITH SWITCHING TOPOLOGY Yiguang HONG Xiaoli WANG Received: 11 May 2009 / Revised: 16 June 2009 c 2009

More information

Multi-agent Second Order Average Consensus with Prescribed Transient Behavior

Multi-agent Second Order Average Consensus with Prescribed Transient Behavior Multi-agent Second Order Average Consensus with Prescribed Transient Behavior Luca Macellari, Yiannis Karayiannidis and Dimos V. Dimarogonas Abstract The problem of consensus reaching with prescribed transient

More information

, respectively to the inverse and the inverse differential problem. Check the correctness of the obtained results. Exercise 2 y P 2 P 1.

, respectively to the inverse and the inverse differential problem. Check the correctness of the obtained results. Exercise 2 y P 2 P 1. Robotics I July 8 Exercise Define the orientation of a rigid body in the 3D space through three rotations by the angles α β and γ around three fixed axes in the sequence Y X and Z and determine the associated

More information

Today: Linear Programming (con t.)

Today: Linear Programming (con t.) Today: Linear Programming (con t.) COSC 581, Algorithms April 10, 2014 Many of these slides are adapted from several online sources Reading Assignments Today s class: Chapter 29.4 Reading assignment for

More information

Directional Redundancy for Robot Control

Directional Redundancy for Robot Control ACCEPTED FOR PUBLICATION IN IEEE TRANSACTIONS ON AUTOMATIC CONTROL Directional Redundancy for Robot Control Nicolas Mansard, François Chaumette, Member, IEEE Abstract The paper presents a new approach

More information

An Adaptive Full-State Feedback Controller for Bilateral Telerobotic Systems

An Adaptive Full-State Feedback Controller for Bilateral Telerobotic Systems 21 American Control Conference Marriott Waterfront Baltimore MD USA June 3-July 2 21 FrB16.3 An Adaptive Full-State Feedback Controller for Bilateral Telerobotic Systems Ufuk Ozbay Erkan Zergeroglu and

More information

13 Path Planning Cubic Path P 2 P 1. θ 2

13 Path Planning Cubic Path P 2 P 1. θ 2 13 Path Planning Path planning includes three tasks: 1 Defining a geometric curve for the end-effector between two points. 2 Defining a rotational motion between two orientations. 3 Defining a time function

More information

MEAM 520. More Velocity Kinematics

MEAM 520. More Velocity Kinematics MEAM 520 More Velocity Kinematics Katherine J. Kuchenbecker, Ph.D. General Robotics, Automation, Sensing, and Perception Lab (GRASP) MEAM Department, SEAS, University of Pennsylvania Lecture 12: October

More information

Penalty and Barrier Methods. So we again build on our unconstrained algorithms, but in a different way.

Penalty and Barrier Methods. So we again build on our unconstrained algorithms, but in a different way. AMSC 607 / CMSC 878o Advanced Numerical Optimization Fall 2008 UNIT 3: Constrained Optimization PART 3: Penalty and Barrier Methods Dianne P. O Leary c 2008 Reference: N&S Chapter 16 Penalty and Barrier

More information

Further Pure Mathematics FP1

Further Pure Mathematics FP1 Write your name here Surname Other names Centre Number Pearson Edexcel GCE Further Pure Mathematics FP1 Advanced/Advanced Subsidiary Friday 20 May 2016 Morning Time: 1 hour 30 minutes You must have: Mathematical

More information

Dynamic and Adversarial Reachavoid Symbolic Planning

Dynamic and Adversarial Reachavoid Symbolic Planning Dynamic and Adversarial Reachavoid Symbolic Planning Laya Shamgah Advisor: Dr. Karimoddini July 21 st 2017 Thrust 1: Modeling, Analysis and Control of Large-scale Autonomous Vehicles (MACLAV) Sub-trust

More information

Online Contact Point Estimation for Uncalibrated Tool Use

Online Contact Point Estimation for Uncalibrated Tool Use Online Contact Point Estimation for Uncalibrated Tool Use Yiannis Karayiannidis, Christian Smith, Francisco E. Viña, and Danica Kragic Abstract One of the big challenges for robots working outside of traditional

More information

Control of Robotic Manipulators

Control of Robotic Manipulators Control of Robotic Manipulators Set Point Control Technique 1: Joint PD Control Joint torque Joint position error Joint velocity error Why 0? Equivalent to adding a virtual spring and damper to the joints

More information

Robotics I. June 6, 2017

Robotics I. June 6, 2017 Robotics I June 6, 217 Exercise 1 Consider the planar PRPR manipulator in Fig. 1. The joint variables defined therein are those used by the manufacturer and do not correspond necessarily to a Denavit-Hartenberg

More information

The Jacobian. Jesse van den Kieboom

The Jacobian. Jesse van den Kieboom The Jacobian Jesse van den Kieboom jesse.vandenkieboom@epfl.ch 1 Introduction 1 1 Introduction The Jacobian is an important concept in robotics. Although the general concept of the Jacobian in robotics

More information

Effect of a robot's geometrical parameters on its optimal dynamic performance

Effect of a robot's geometrical parameters on its optimal dynamic performance University of Wollongong Research Online Faculty of Engineering - Papers (Archive) Faculty of Engineering and Information Sciences 1992 Effect of a robot's geometrical parameters on its optimal dynamic

More information

minimize x x2 2 x 1x 2 x 1 subject to x 1 +2x 2 u 1 x 1 4x 2 u 2, 5x 1 +76x 2 1,

minimize x x2 2 x 1x 2 x 1 subject to x 1 +2x 2 u 1 x 1 4x 2 u 2, 5x 1 +76x 2 1, 4 Duality 4.1 Numerical perturbation analysis example. Consider the quadratic program with variables x 1, x 2, and parameters u 1, u 2. minimize x 2 1 +2x2 2 x 1x 2 x 1 subject to x 1 +2x 2 u 1 x 1 4x

More information

Robotics & Automation. Lecture 17. Manipulability Ellipsoid, Singularities of Serial Arm. John T. Wen. October 14, 2008

Robotics & Automation. Lecture 17. Manipulability Ellipsoid, Singularities of Serial Arm. John T. Wen. October 14, 2008 Robotics & Automation Lecture 17 Manipulability Ellipsoid, Singularities of Serial Arm John T. Wen October 14, 2008 Jacobian Singularity rank(j) = dimension of manipulability ellipsoid = # of independent

More information

Eigenvectors and Eigenvalues 1

Eigenvectors and Eigenvalues 1 Ma 2015 page 1 Eigenvectors and Eigenvalues 1 In this handout, we will eplore eigenvectors and eigenvalues. We will begin with an eploration, then provide some direct eplanation and worked eamples, and

More information

Balanced Truncation 1

Balanced Truncation 1 Massachusetts Institute of Technology Department of Electrical Engineering and Computer Science 6.242, Fall 2004: MODEL REDUCTION Balanced Truncation This lecture introduces balanced truncation for LTI

More information

Linear Algebra (Review) Volker Tresp 2017

Linear Algebra (Review) Volker Tresp 2017 Linear Algebra (Review) Volker Tresp 2017 1 Vectors k is a scalar (a number) c is a column vector. Thus in two dimensions, c = ( c1 c 2 ) (Advanced: More precisely, a vector is defined in a vector space.

More information

Case Study: The Pelican Prototype Robot

Case Study: The Pelican Prototype Robot 5 Case Study: The Pelican Prototype Robot The purpose of this chapter is twofold: first, to present in detail the model of the experimental robot arm of the Robotics lab. from the CICESE Research Center,

More information

Probabilistic Prioritization of Movement Primitives

Probabilistic Prioritization of Movement Primitives Probabilistic Prioritization of Movement Primitives Alexandros Paraschos 1,, Rudolf Lioutikov 1, Jan Peters 1,3 and Gerhard Neumann Abstract Movement prioritization is a common approach to combine controllers

More information

Two-Link Flexible Manipulator Control Using Sliding Mode Control Based Linear Matrix Inequality

Two-Link Flexible Manipulator Control Using Sliding Mode Control Based Linear Matrix Inequality IOP Conference Series: Materials Science and Engineering PAPER OPEN ACCESS Two-Link Flexible Manipulator Control Using Sliding Mode Control Based Linear Matrix Inequality To cite this article: Zulfatman

More information

Control of Mobile Robots

Control of Mobile Robots Control of Mobile Robots Regulation and trajectory tracking Prof. Luca Bascetta (luca.bascetta@polimi.it) Politecnico di Milano Dipartimento di Elettronica, Informazione e Bioingegneria Organization and

More information

Tracking Control of Robot Manipulators with Bounded Torque Inputs* W.E. Dixon, M.S. de Queiroz, F. Zhang and D.M. Dawson

Tracking Control of Robot Manipulators with Bounded Torque Inputs* W.E. Dixon, M.S. de Queiroz, F. Zhang and D.M. Dawson Robotica (1999) volume 17, pp. 121 129. Printed in the United Kingdom 1999 Cambridge University Press Tracking Control of Robot Manipulators with Bounded Torque Inputs* W.E. Dixon, M.S. de Queiroz, F.

More information

On the stability of nonholonomic multi-vehicle formation

On the stability of nonholonomic multi-vehicle formation Abstract On the stability of nonholonomic multi-vehicle formation Lotfi Beji 1, Mohamed Anouar ElKamel 1, Azgal Abichou 2 1 University of Evry (IBISC EA 4526), 40 rue du Pelvoux, 91020 Evry Cedex, France

More information

Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties

Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties Australian Journal of Basic and Applied Sciences, 3(1): 308-322, 2009 ISSN 1991-8178 Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties M.R.Soltanpour, M.M.Fateh

More information

Paper1Practice [289 marks]

Paper1Practice [289 marks] PaperPractice [89 marks] INSTRUCTIONS TO CANDIDATE Write your session number in the boxes above. Do not open this examination paper until instructed to do so. You are not permitted access to any calculator

More information

Robotics I Kinematics, Dynamics and Control of Robotic Manipulators. Velocity Kinematics

Robotics I Kinematics, Dynamics and Control of Robotic Manipulators. Velocity Kinematics Robotics I Kinematics, Dynamics and Control of Robotic Manipulators Velocity Kinematics Dr. Christopher Kitts Director Robotic Systems Laboratory Santa Clara University Velocity Kinematics So far, we ve

More information

Distributed Coordinated Tracking With Reduced Interaction via a Variable Structure Approach Yongcan Cao, Member, IEEE, and Wei Ren, Member, IEEE

Distributed Coordinated Tracking With Reduced Interaction via a Variable Structure Approach Yongcan Cao, Member, IEEE, and Wei Ren, Member, IEEE IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 57, NO. 1, JANUARY 2012 33 Distributed Coordinated Tracking With Reduced Interaction via a Variable Structure Approach Yongcan Cao, Member, IEEE, and Wei Ren,

More information

Stanford Artificial Intelligence Laboratory Stanford University, CA 94305, USA

Stanford Artificial Intelligence Laboratory Stanford University, CA 94305, USA Kinematic and dynamic model-based control of wheeled mobile manipulators: a unified framework for reactive approaches V. Padois, J.-Y. Fourquet, P. Chiron Stanford Artificial Intelligence Laboratory Stanford

More information

Linear Algebra (Review) Volker Tresp 2018

Linear Algebra (Review) Volker Tresp 2018 Linear Algebra (Review) Volker Tresp 2018 1 Vectors k, M, N are scalars A one-dimensional array c is a column vector. Thus in two dimensions, ( ) c1 c = c 2 c i is the i-th component of c c T = (c 1, c

More information

Linear Equations in Linear Algebra

Linear Equations in Linear Algebra 1 Linear Equations in Linear Algebra 1.4 THE MATRIX EQUATION A = b MATRIX EQUATION A = b m n Definition: If A is an matri, with columns a 1, n, a n, and if is in, then the product of A and, denoted by

More information

Operational Space Control of Constrained and Underactuated Systems

Operational Space Control of Constrained and Underactuated Systems Robotics: Science and Systems 2 Los Angeles, CA, USA, June 27-3, 2 Operational Space Control of Constrained and Underactuated Systems Michael Mistry Disney Research Pittsburgh 472 Forbes Ave., Suite Pittsburgh,

More information

Lecture «Robot Dynamics» : Kinematics 3

Lecture «Robot Dynamics» : Kinematics 3 Lecture «Robot Dynamics» : Kinematics 3 151-0851-00 V lecture: CAB G11 Tuesday 10:15-12:00, every week exercise: HG G1 Wednesday 8:15-10:00, according to schedule (about every 2nd week) office hour: LEE

More information

Μια προσπαθεια για την επιτευξη ανθρωπινης επιδοσης σε ρομποτικές εργασίες με νέες μεθόδους ελέγχου

Μια προσπαθεια για την επιτευξη ανθρωπινης επιδοσης σε ρομποτικές εργασίες με νέες μεθόδους ελέγχου Μια προσπαθεια για την επιτευξη ανθρωπινης επιδοσης σε ρομποτικές εργασίες με νέες μεθόδους ελέγχου Towards Achieving Human like Robotic Tasks via Novel Control Methods Zoe Doulgeri doulgeri@eng.auth.gr

More information

CS 5522: Artificial Intelligence II

CS 5522: Artificial Intelligence II CS 5522: Artificial Intelligence II Hidden Markov Models Instructor: Wei Xu Ohio State University [These slides were adapted from CS188 Intro to AI at UC Berkeley.] Pacman Sonar (P4) [Demo: Pacman Sonar

More information

Computation of a canonical form for linear differential-algebraic equations

Computation of a canonical form for linear differential-algebraic equations Computation of a canonical form for linear differential-algebraic equations Markus Gerdin Division of Automatic Control Department of Electrical Engineering Linköpings universitet, SE-581 83 Linköping,

More information

CS 5522: Artificial Intelligence II

CS 5522: Artificial Intelligence II CS 5522: Artificial Intelligence II Hidden Markov Models Instructor: Alan Ritter Ohio State University [These slides were adapted from CS188 Intro to AI at UC Berkeley. All materials available at http://ai.berkeley.edu.]

More information

Seul Jung, T. C. Hsia and R. G. Bonitz y. Robotics Research Laboratory. University of California, Davis. Davis, CA 95616

Seul Jung, T. C. Hsia and R. G. Bonitz y. Robotics Research Laboratory. University of California, Davis. Davis, CA 95616 On Robust Impedance Force Control of Robot Manipulators Seul Jung, T C Hsia and R G Bonitz y Robotics Research Laboratory Department of Electrical and Computer Engineering University of California, Davis

More information

Whole Body Control of a Dual Arm Underwater Vehicle Manipulator System

Whole Body Control of a Dual Arm Underwater Vehicle Manipulator System Whole Body Control of a Dual Arm Underwater Vehicle Manipulator System E. Simetti G. Casalino Interuniversity Research Center on Integrated Systems for the Marine Environment (ISME) Department of Computer

More information

The Dynamic Postural Adjustment with the Quadratic Programming Method

The Dynamic Postural Adjustment with the Quadratic Programming Method The Dynamic Postural Adjustment with the Quadratic Programming Method Shunsuke Kudoh 1, Taku Komura 2, Katsushi Ikeuchi 3 1 University of Tokyo, Tokyo, Japan, kudoh@cvl.iis.u-tokyo.ac.jp 2 RIKEN, Wakou,

More information

1 Introduction. 2 Successive Convexification Algorithm

1 Introduction. 2 Successive Convexification Algorithm 1 Introduction There has been growing interest in cooperative group robotics [], with potential applications in construction and assembly. Most of this research focuses on grounded or mobile manipulator

More information

THE classical objectives considered in automatic control

THE classical objectives considered in automatic control Control Barrier Functions for Signal Temporal Logic Tasks Lars Lindemann, Student Member, IEEE, and Dimos V. Dimarogonas, Senior Member, IEEE Abstract The need for computationally-efficient control methods

More information

The Reflexxes Motion Libraries. An Introduction to Instantaneous Trajectory Generation

The Reflexxes Motion Libraries. An Introduction to Instantaneous Trajectory Generation ICRA Tutorial, May 6, 2013 The Reflexxes Motion Libraries An Introduction to Instantaneous Trajectory Generation Torsten Kroeger 1 Schedule 8:30-10:00 Introduction and basics 10:00-10:30 Coffee break 10:30-11:30

More information

Multiple-priority impedance control

Multiple-priority impedance control Multiple-priority impedance control Robert Platt Jr, Muhammad Abdallah, and Charles Wampler Abstract Impedance control is well-suited to robot manipulation applications because it gives the designer a

More information

GAIN SCHEDULING CONTROL WITH MULTI-LOOP PID FOR 2- DOF ARM ROBOT TRAJECTORY CONTROL

GAIN SCHEDULING CONTROL WITH MULTI-LOOP PID FOR 2- DOF ARM ROBOT TRAJECTORY CONTROL GAIN SCHEDULING CONTROL WITH MULTI-LOOP PID FOR 2- DOF ARM ROBOT TRAJECTORY CONTROL 1 KHALED M. HELAL, 2 MOSTAFA R.A. ATIA, 3 MOHAMED I. ABU EL-SEBAH 1, 2 Mechanical Engineering Department ARAB ACADEMY

More information

E5295/5B5749 Convex optimization with engineering applications. Lecture 5. Convex programming and semidefinite programming

E5295/5B5749 Convex optimization with engineering applications. Lecture 5. Convex programming and semidefinite programming E5295/5B5749 Convex optimization with engineering applications Lecture 5 Convex programming and semidefinite programming A. Forsgren, KTH 1 Lecture 5 Convex optimization 2006/2007 Convex quadratic program

More information

Third-Order Tensor Decompositions and Their Application in Quantum Chemistry

Third-Order Tensor Decompositions and Their Application in Quantum Chemistry Third-Order Tensor Decompositions and Their Application in Quantum Chemistry Tyler Ueltschi University of Puget SoundTacoma, Washington, USA tueltschi@pugetsound.edu April 14, 2014 1 Introduction A tensor

More information

Revision Checklist. Unit FP3: Further Pure Mathematics 3. Assessment information

Revision Checklist. Unit FP3: Further Pure Mathematics 3. Assessment information Revision Checklist Unit FP3: Further Pure Mathematics 3 Unit description Further matrix algebra; vectors, hyperbolic functions; differentiation; integration, further coordinate systems Assessment information

More information

Distributed Event-Based Control for Interconnected Linear Systems

Distributed Event-Based Control for Interconnected Linear Systems 211 5th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC Orlando, FL, USA, December 12-15, 211 Distributed Event-Based Control for Interconnected Linear Systems M Guinaldo,

More information

Visual Servoing with Quick Eye-Vergence to Enhance Trackability and Stability

Visual Servoing with Quick Eye-Vergence to Enhance Trackability and Stability x x The 21 IEEE/RSJ International Conference on Intelligent Robots and Systems October 18-22, 21, Taipei, Taiwan Visual Servoing with Quick Eye-Vergence to Enhance Trackability and Stability Abstract Visual

More information

Manipulator Dynamics 2. Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA

Manipulator Dynamics 2. Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA Manipulator Dynamics 2 Forward Dynamics Problem Given: Joint torques and links geometry, mass, inertia, friction Compute: Angular acceleration of the links (solve differential equations) Solution Dynamic

More information

Core Mathematics C12

Core Mathematics C12 Write your name here Surname Other names Pearson Edexcel International Advanced Level Centre Number Candidate Number Core Mathematics C12 Advanced Subsidiary Monday 10 October 2016 Morning Time: 2 hours

More information

A Sliding Mode Control based on Nonlinear Disturbance Observer for the Mobile Manipulator

A Sliding Mode Control based on Nonlinear Disturbance Observer for the Mobile Manipulator International Core Journal of Engineering Vol.3 No.6 7 ISSN: 44-895 A Sliding Mode Control based on Nonlinear Disturbance Observer for the Mobile Manipulator Yanna Si Information Engineering College Henan

More information

Real Time Stochastic Control and Decision Making: From theory to algorithms and applications

Real Time Stochastic Control and Decision Making: From theory to algorithms and applications Real Time Stochastic Control and Decision Making: From theory to algorithms and applications Evangelos A. Theodorou Autonomous Control and Decision Systems Lab Challenges in control Uncertainty Stochastic

More information

Robotics. Kinematics. Marc Toussaint University of Stuttgart Winter 2017/18

Robotics. Kinematics. Marc Toussaint University of Stuttgart Winter 2017/18 Robotics Kinematics 3D geometry, homogeneous transformations, kinematic map, Jacobian, inverse kinematics as optimization problem, motion profiles, trajectory interpolation, multiple simultaneous tasks,

More information

MA 123 September 8, 2016

MA 123 September 8, 2016 Instantaneous velocity and its Today we first revisit the notion of instantaneous velocity, and then we discuss how we use its to compute it. Learning Catalytics session: We start with a question about

More information

Trajectory-tracking control of a planar 3-RRR parallel manipulator

Trajectory-tracking control of a planar 3-RRR parallel manipulator Trajectory-tracking control of a planar 3-RRR parallel manipulator Chaman Nasa and Sandipan Bandyopadhyay Department of Engineering Design Indian Institute of Technology Madras Chennai, India Abstract

More information

Introduction to Mobile Robotics SLAM: Simultaneous Localization and Mapping

Introduction to Mobile Robotics SLAM: Simultaneous Localization and Mapping Introduction to Mobile Robotics SLAM: Simultaneous Localization and Mapping Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz What is SLAM? Estimate the pose of a robot and the map of the environment

More information