jane li - wpiusers.wpi.edu/~zli11/teaching/rbe595_2017/lectureslide... · 2018-04-12 ·...
TRANSCRIPT
Jane Li
Assistant Professor
Mechanical Engineering Department, Robotic Engineering Program
Worcester Polytechnic Institute
• The foot segment is subjected to the pull of two plantarflexor muscles. Determine the moment of each force about the point of contact A on the ground.
• Compute moment (M_A)_1, and (M_A)_2
• Unit for moment: lb*in
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 2
• The foot segment is subjected to the pull of two plantarflexor muscles. Determine the moment of each force about the point of contact A on the ground.
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 3
• Active Projects
• Teleoperating a Humanoid Nursing Robot from Motion Capture System
• Vision-based reactive motion control for human-robot handing-over
• Building a haptic devices for home-based stroke rehab
• Arm-hand-finger Coordination
• Human driver motion study
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 4
• Teleoperating a Humanoid Nursing Robot from Motion Capture System
• YudongYU <[email protected]>
• Arjun Jagdish <[email protected]>
• Sanjuksha Nirgude <[email protected]>
• Tianyu Cheng <[email protected]>
• Sihui Li <[email protected]>
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 5
• Vision-based reactive motion control for human-robot handing-over
• Gunnar Horve <[email protected]>
• Heramb Nemlekar <[email protected]>
• Himanshu Raghuvanshi <[email protected]>
• Onkar Trivedi <[email protected]>
• Dharini Dutia <[email protected]>
• Rohit Voleti <[email protected]>
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 6
• Building a haptic devices for home-based stroke rehab
• Nathaniel Goldfarb <[email protected]>
• Rishi Khajuriwala <[email protected]>
• Aishwary Jagetia <[email protected]>
• Nishant Shah <[email protected]>
• Brandon Lam <[email protected]>
• Akshay Kumar <[email protected]>
• Matthew Bowers <[email protected]>
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 7
• Arm-hand-finger Coordination
• Haowei Zhao <[email protected]>
• Aniketh Reddy Seelam <[email protected]>
• Gaurav Vikhe <[email protected]>
• Aayush Shah <[email protected]>
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 8
• Human driver motion study
• Kenechukwu Mbanisi <[email protected]>
• Tess Meier <[email protected]>
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 9
• Try to find the best match • Your choice, skill sets and preferred teammates
• More or fewer students per team • Will adjust project scope and objectives
• Need a leader/coordinator for each team
• Plan for project data management• Your hardware design files, code & documentation, reports, etc
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 10
• Frame transform
• Forward Kinematics
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 11
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 13
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 14
Reference Frame
Position Vector
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 15
Reference Frame
Body Frame
• Reference frame {A}• Body Frame {B}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 16
Frame orientation
Origin position
• {B} is translated w.r.t. {A}
• Given a point P’s position in {B}, what is its position w.r.t. {A}?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 17
• {B} is rotated w.r.t. {A}
• Given a point P’s position in {B}, what is its position w.r.t. {A}?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 18
?
• Given
• Compute
• Solution
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 19
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 20
• Rotating about a fixed frame
• Rotating about a moving frame
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 21
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 22
abg
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 23
a b g
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 24
Rotate about a fixed frame
Rotate about a moving frame
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 25
• Given
• Compute
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 26
• Describe the transform between two frames attached to two connected links.
• Possible ways for connection?
• Joint types
• Pose = position + orientation
• How many parameters do you need?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 29
• Link twist a
• Angle between two Z-axes
• Link length a
• Distance between two Z-axes
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 30
• Link length?
• Link twist?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 31
• Joint angle q
• Angle between two X-axis
• Link offset d
• Distance between two X-axes
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 32
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 33
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 34
Standard form
Modified form
• Link twist a
• Link length a
• Joint angle q
• Link offset d
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 35
• Link twist a
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 36
• Link length a
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 37
• Joint angle q
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 38
• Link offset d
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 39
• Relate Frame {N} to Frame {0}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 40
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 41
• Frame {0} = base
• Frame {1} w.r.t. Frame {0}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 42
• Frame {2} w.r.t. Frame {1}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 43
cv
cv
• Frame {3} w.r.t. Frame {2}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 44
cv
cv
• Frame {4} w.r.t. Frame {3}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 45
cvcv
• Frame {5} w.r.t. Frame {4}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 46
cv
cv
• Frame {6} w.r.t. Frame {5}
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 47
cv cv
• Derive the DH parameters for Puma 560
• Implement the FK of Puma 560 in Matlab
• EE_pose = FK(DH parameter table)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 48
• Robot Simian
• Open-loop kinematics?
• Raise one arm
• Control EE pose
• Close-loop kinematics?
• Fix the foot on ground
• Control the torso pose
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 51
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 52
• Inverse Kinematics is easier
• Forward Kinematics is harder
• Why?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 53
• Mobility of this platform F?
• Each movable link is a rigid body
• Number of movable links
• Number of joints
• Number of DOFs at joint each joint
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 54
• Mobility of this platform F?• Each movable link has N DOFs
• N = 6 (3D workspace)
• Number of movable links: • k = 14 (each bar can extend and retract)
• Number of joints: • n1 = 12 (rotational), n2 = 6 (prismatic)
• Number of DOFs at joint i: • f1 = 3, f2 = 1
• Equation• F = N[k – (n1+n2) – 1] + (n1*3 + n2*1)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 55
• Determine the end-effector position P
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 56
Inverse Kinematics
Forward Kinematics
• Control 6-DOF pose of the platform?
• Highly nonlinear
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 57
• Solve the high degree polynomial equations for FK
• Newton–Raphson method
• Computationally intensive
• Decouple the position and orientation parameters
• Can speed the computation to some extent
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 58
• Neural network
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 59
ACON = all class one network OCON = one class one network
Approximate solution
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 60
• [1] Parikh, Pratik J., and Sarah SY Lam. "A hybrid strategy to solve the forward kinematics problem in parallel manipulators." IEEE Transactions on Robotics 21.1 (2005): 18-25.
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 61
• (10 pt) Derive the DH parameters for Puma 560
• DH parameter table
• (10 pt) Implement the FK of Puma 560 in Matlab
• EE_pose = FK(DH parameter table)
• (10 pt) Optional
• Can you try a NN to solve FK and IK of a 3DOF serial manipulator?
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 62