Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 ·...
Transcript of Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 ·...
![Page 1: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/1.jpg)
Jane Li
Assistant Professor
Mechanical Engineering Department, Robotic Engineering Program
Worcester Polytechnic Institute
![Page 2: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/2.jpg)
• 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
![Page 3: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/3.jpg)
• 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
![Page 4: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/4.jpg)
• 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
![Page 5: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/5.jpg)
• 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
![Page 6: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/6.jpg)
• 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
![Page 7: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/7.jpg)
• 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
![Page 8: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/8.jpg)
• 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
![Page 9: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/9.jpg)
• 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
![Page 10: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/10.jpg)
• 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
![Page 11: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/11.jpg)
• 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
![Page 12: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/12.jpg)
![Page 13: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/13.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 13
![Page 14: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/14.jpg)
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
![Page 15: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/15.jpg)
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
![Page 16: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/16.jpg)
• 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
![Page 17: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/17.jpg)
• {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
![Page 18: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/18.jpg)
• {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
?
![Page 19: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/19.jpg)
• Given
• Compute
• Solution
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 19
![Page 20: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/20.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 20
![Page 21: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/21.jpg)
• 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
![Page 22: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/22.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 22
abg
![Page 23: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/23.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 23
a b g
![Page 24: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/24.jpg)
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
![Page 25: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/25.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 25
![Page 26: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/26.jpg)
• Given
• Compute
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 26
![Page 27: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/27.jpg)
![Page 28: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/28.jpg)
• Describe the transform between two frames attached to two connected links.
• Possible ways for connection?
• Joint types
![Page 29: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/29.jpg)
• 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
![Page 30: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/30.jpg)
• 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
![Page 31: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/31.jpg)
• 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
![Page 32: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/32.jpg)
• 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
![Page 33: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/33.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 33
![Page 34: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/34.jpg)
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
![Page 35: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/35.jpg)
• 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
![Page 36: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/36.jpg)
• Link twist a
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 36
![Page 37: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/37.jpg)
• Link length a
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 37
![Page 38: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/38.jpg)
• Joint angle q
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 38
![Page 39: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/39.jpg)
• Link offset d
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 39
![Page 40: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/40.jpg)
• 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
![Page 41: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/41.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 41
![Page 42: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/42.jpg)
• 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
![Page 43: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/43.jpg)
• 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
![Page 44: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/44.jpg)
• 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
![Page 45: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/45.jpg)
• 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
![Page 46: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/46.jpg)
• 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
![Page 47: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/47.jpg)
• 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
![Page 48: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/48.jpg)
• 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
![Page 49: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/49.jpg)
![Page 50: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/50.jpg)
![Page 51: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/51.jpg)
• 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
![Page 52: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/52.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 52
![Page 53: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/53.jpg)
• 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
![Page 54: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/54.jpg)
• 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
![Page 55: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/55.jpg)
• 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
![Page 56: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/56.jpg)
• 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
![Page 57: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/57.jpg)
• 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
![Page 58: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/58.jpg)
• 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
![Page 59: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/59.jpg)
• 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
![Page 60: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/60.jpg)
9/11/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 60
![Page 61: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/61.jpg)
• [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
![Page 62: Jane Li - WPIusers.wpi.edu/~zli11/teaching/rbe595_2017/LectureSlide... · 2018-04-12 · •Building a haptic devices for home-based stroke rehab •Nathaniel Goldfarb](https://reader034.fdocuments.us/reader034/viewer/2022050509/5f9a792014620429a814674b/html5/thumbnails/62.jpg)
• (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