Upload
others
View
3
Download
0
Embed Size (px)
Citation preview
2/12/20
1
Space RoboticsSpace System Design, MAE 342, Princeton University
Robert Stengel
Copyright 2016 by Robert Stengel. All rights reserved. For educational use only.http://www.princeton.edu/~stengel/MAE342.html 1
§ Robots and Robotics§ Autonomous Spacecraft§ Planetary and Lunar Rovers§ Path Planning§ Robotic Arms§ Robonauts§ Deep Impact 1
1
Robots and Robotics
• Design, manufacture, control, and programming of robots
• Use of robots to solve problems• Study of control processes, sensors, and
algorithms used in humans, animals, and machines• Application of control processes and algorithms to
designing robots
2
2
2/12/20
2
Biomimetics (Bionics)• Understanding biological principles
and applying them to system design– Configuration– Structure– Behavior– Dynamics– Control
3
3
Autonomous Robots • Self control• Self maintenance• Awareness of
environment• Task orientation• Mission specificity
4
• Power source• Cooperation and
collaboration• = Intelligence?• Self replication?• Ethical issues
4
2/12/20
3
Elements of Intelligent Control
Intelligent Control System
5
Declarative Functions Expert Systems, Decision TreesProcedural Functions Estimation and Control "Circuits"Reflexive Functions Control Laws, Neural Networks
5
Robotic Vehicles
6
6
2/12/20
4
Expendable (Rocket) Launch Vehicles
Current space launch vehicles are largely autonomous
Atlas Vhttp://www.youtube.com/watch?v=K
xQbex7LJwg
Delta 4
7
7
• Reusable experimental/operational vehicle
• Unmanned “mini-Space Shuttle”
• Highly classified project
• 1st 3 missions: 224, 469, & 675 days in orbit
• 4th mission on-going
X-37B
8
8
2/12/20
5
Orbital Express: ASTRO and NEXTSat• DARPA, 2007
–Automatic rendezvous, docking, and undocking
–On-orbit transfer of replaceable units
–6DOF robot arm–Video guidance sensor–Atlas 5 launch
9https://en.m.wikipedia.org/wiki/Robotic_spacecraft
9
Mars Science Laboratory(Curiosity)
• Transport science payload over Martian surface– Rocker-bogie suspension
• Communications with Earth• Guidance, navigation, and
control• Power supply• Support for deployable
devices• Size ~ Mini-Cooper• Landed, 8/6/12, and
operational
Curiosity Trailerhttp://www.jpl.nasa.gov/video/details.php?id=1014
10
10
2/12/20
6
Curiosity Rocker-Bogie Suspension
11
Curiosity Robotic Arms
11
Curiosity Preparation, Spacecraft, and Aeroshell
12
12
2/12/20
7
Curiosity Approach and Landing
13
13
Mars Opportunity Rover Navigation
14
14
2/12/20
8
Google LunarX Prize
15
Astrobotic Lunar Lander
Express MX-1
Lunar XPrize India
SpaceIL Lander
https://en.m.wikipedia.org/wiki/Google_Lunar_X_Prize
1st privately funded spacecraft to land on Moon, travel 500m, and stream live TV
15
Path Planning on Occupancy Grid
16
Admissible and Inadmissible Blocks
• Identify feasible paths from Start to Goal• Chose path that best satisfies criteria, e.g.,
– Simplicity of calculation– Lowest cost– Highest performance
16
2/12/20
9
17
1) Identify shortest unconstrained path from Start to Goal2) Chose path that navigates the boundary
1) Stays as close as to possible to unconstrained path2) Satisfies constraint3) Follows simple rule, e.g., “stay to the left”
Bug Path Planning
17
D* or A* Path Planning
18
• Determine occupancy cost of each block• Chose path from Start to Goal that minimizes
occupancy cost with each step
18
2/12/20
10
Probabilistic Road Map
• Construction Phase: Random configuration of admissible points• Connect admissible points to nearest neighbors
• Assessment Phase: Assess incremental cost of traveling along each “edge” between points
• Query Phase: Find all feasible paths from Start to Goal and select lowest cost path
19
Note that this approach would miss the lowest cost path found on the previous slide
19
Rapidly Exploring Random Trees (RRT, RRT*)
§ RRT§ Space-filling tree evolves from Start§ Open-loop trajectories with state constraints§ Initially feasible solution converges to
optimal solution through searching§ RRT*
§ “Committed trajectories”§ Branch-and-bound tree adaptation§ Provable convergence
20
20
2/12/20
11
21
Interpolation
• Piecewise polynomials (linear -> quintic)• End-point discontinuities• End-point constraints
• Single polynomial through all points• Polynomial degree = # of points – 1• Sensitivity to high-degree terms (e.g., ct6)• Possibility of large excursions between points
• Polynomials through adjacent points• e.g., cubic B splines
Connect the Dots
21
Path Planning with Potential Fields
Features attract or repel path from Start to Goal, e.g., +/– gravity fields
22
22
2/12/20
12
Simultaneous Location and Mapping (SLAM)
• Build or update a local map within an unknown environment– Stochastic map, defined by mean and
covariance of many points– Landmark, terrain, and target tracking– Multi-sensor integration– SLAM Algorithm = Bank of state
estimators
Durrant- Whyte et al
23
23
Mars Aerial Regional-Scale Environmental Survey (ARES)
Research Airplane Concept, ~2008
24
https://www.youtube.com/watch?v=wAOTOmGFs5M
https://www.youtube.com/watch?v=8YutbpJuFiI
24
2/12/20
13
ARES System Layout
25
25
Articulated Robot Arms
26
26
2/12/20
14
Robot Arms for SpaceDEXTRE Manipulator, ISS
Canadarm2, ISS
Curiosity Robot Arm
Kibo Arm, ISS
27
27
DEXTRE
28https://en.m.wikipedia.org/wiki/Dextre
28
2/12/20
15
Manipulator Redundancy and Degeneracy
• More than one link configuration may provide a given end point if dim(xJ) ≥ dim(xE) ≥ dim(xT)
• Redundancy: Finite number of joint vectors provide the same task-dependent vector
• Degeneracy: Infinite number of joint vectors provide the same task-dependent vector
• Co-linear joint axes are degenerate
29
29
Space Robot Arms are Highly Redundant
Why?
30
30
2/12/20
16
Robot Arm Configurations
McKerrow, 1991
CartesianCylindrical
Polar Articulated Revolute
31
31
Robot Arm Workspaces
McKerrow, 1991
Cylindrical
ArticulatedRevolute
32
32
2/12/20
17
Serial Robotic Manipulators
• Serial chain of robotic links and joints– Large workspace– Low stiffness– Cumulative errors from link
to link– Proximal links carry the
weight and load of distal links
– Actuation of proximal joints affects distal links
– Limited load-carrying capability at end effecter
Proximal link: closer to the baseDistal link: farther from the base
33
33
NASA/GM Robonaut R2
Robonauthttp://www.youtube.com/watch?v=g3u48T4Vx7k
34
34
2/12/20
18
Robonaut 2 Structure
35
35
Robonaut 2 Hand
36
36
2/12/20
19
Robonaut 2 Fingers
37
• Control by tendons and four-bar linkages
• Linear actuators in forearm
Index Finger
Thumb
37
Four-Bar Linkage
38
• Closed-loop structure
• Rotational joints• Planar motion• Proportions of link
lengths determine pattern of motion
38
2/12/20
20
39
Robonaut 2 Wrist and Forearm
39
Revolute Robotic JointsRotation about a single axis
Parallel to Link
Perpendicular to Link
40
40
2/12/20
21
Prismatic Robotic JointsSliding along a single axis
41
41
Other Robotic Joints
Cylindrical (sliding and turning composite)
Roller ScrewFlexible
Spherical (or ball)
Planar (sliding and turning composite)
Universal Constant-Velocity
42
42
2/12/20
22
Characteristic Transformation of a Link
• Each link type has a characteristic transformation matrixrelating the proximal joint to the distal joint
• Link n has– Proximal end: Joint n,
coordinate frame n – 1– Distal end: Joint n + 1,
coordinate frame n
Link: solid structure between two joints
McKerrow, 1991
Proximal
Distal
43
43
Links Between Revolute Joints• Link: solid structure between two
joints– Proximal end: closer to the base– Distal end: farther from the base
• 4 Link Parameters– Length of the link between rotational
axes, l, along the common normal– Twist angle between axes, α– Angle between 2 links, θ (revolute)– Offset between links, d (prismatic)
• Joint Variable: single link parameterthat is free to vary
Type 1 LinkTwo parallel revolute joints
Type 2 LinkTwo non-parallel revolute joints
McKerrow, 1991 44
44
2/12/20
23
Homogeneous TransformationMatrix
snew =
RotationMatrix
⎛⎝⎜
⎞⎠⎟ old
new Locationof OldOrigin
⎛
⎝
⎜⎜
⎞
⎠
⎟⎟new
0 0 0( ) 1
⎡
⎣
⎢⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥⎥
sold = Aoldnew sold
4 ×1( )new =3× 3( ) 3×1( )1× 3( ) 1×1( )
⎡
⎣⎢⎢
⎤
⎦⎥⎥4 ×1( )old = 4 × 4( )⎡⎣ ⎤⎦ 4 ×1( )old
45
Express rotation and translation in a single transformation
45
Homogeneous Transformation• Rotation and translation can be expressed in terms
of homogeneous coordinates– Single matrix-vector product produces rotation and
transformation
• or
snew =Hold
new roldnew
0 0 0( ) 1
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥sold = A sold
xyx1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥new
=
h11 h12 h13 xoh21 h22 h23 yoh31 h32 h33 zo0 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
xyz1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥old
46
46
2/12/20
24
Equivalent Scalar Equations for Homogeneous Transformation
xyx1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥new
=
h11 h12 h13 xoh21 h22 h23 yoh31 h32 h33 zo0 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
xyz1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥old
�
snew =A oldnew sold
Matrix-Vector Multiplication
Individual Operations
xnew = h11xold + h12yold + h13zold + xoynew = h21xold + h22yold + h23zold + yoznew = h31xold + h32yold + h33zold + zo− − − −1= 1
47
47
Series of Homogeneous Transformations
s2 = A12A0
1 s0 = A02 s0
Two serial transformations can be combined in a single transformation
Four transformations for SCARA robot
s4 = A34A2
3A12A0
1 s0 = A04 s0
48
48
2/12/20
25
Transformation for a Single Robotic Joint
• Each joint requires four sequentialtransformations:– Rotation about α– Translation along d– Translation along l– Rotation about θ
Type 2 Link
sn+1 = A3n+1A2
3A12An
1 sn = Ann+1 sn
= AθAdAlAα sn = Ann+1 sn
• ... axes for each transformation (along or around) must be specified
sn+1 = A zn−1,θn( )A zn−1,dn( )A xn−1,ln( )A xn−1,αn( ) sn = Ann+1 sn
1st2nd3rd4th
49
49
Denavit-HartenbergRepresentation of Joint-
Link-Joint Transformation
An =
cosθn − sinθn 0 0sinθn cosθn 0 00 0 1 00 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
1 0 0 00 1 0 00 0 1 dn0 0 0 1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥
1 0 0 ln0 1 0 00 0 1 00 0 0 1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥
1 0 0 00 cosαn − sinαn 00 sinαn cosαn 00 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
An =
cosθn −sinθn cosα n sinθn sinα n ln cosθn
sinθn cosθn cosα n −cosθn sinα n ln sinθn
0 sinα n cosα n dn0 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
50
FirstThenThenThen
50
2/12/20
26
Forward and Inverse TransformationsForward transformation through links requires pre-multiplication of matrices
s1 = A01s0 ; s2 = A1
2s1 = A12A0
1s0 = A02s0
Reverse transformation uses the matrix inverse
s0 = A02( )−1 s2 = A2
0s2 = A10A2
1s2
51
51
Homogeneous Transformation Matrix is not Orthonormal
A20 = A0
2( )−1 ≠ A02( )T
52
…but a useful identity makes inversion simple
52
2/12/20
27
Matrix Inverse IdentityForward transformation
A1 A2
A3 A4
⎡
⎣⎢⎢
⎤
⎦⎥⎥=
Holdnew ro
0 0 0( ) 1
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥
Inverse
A1 A2
A3 A4
⎡
⎣⎢⎢
⎤
⎦⎥⎥
−1
=Hnew
old −Hnewold ro
0 0 0( ) 1
⎡
⎣
⎢⎢
⎤
⎦
⎥⎥
53
53
Manipulator Maneuvering Spaces
Joint space: Vector of joint variables, e.g.,
rJ = θwaist θshoulder θelbow θwrist−bend θ flange θwrist− twist⎡⎣
⎤⎦T
End-effecter space: Vector of end-effecter positions, e.g.,
rE = xtool ytool ztool ψ tool θtool φtool⎡⎣
⎤⎦T
Task space: Vector of task-dependent positions, e.g., locating a symmetric grinding tool above a horizontal surface:
rT = xtool ytool ztool ψ tool θtool⎡⎣
⎤⎦T
54
54
2/12/20
28
Forward and Inverse Transformations of a Robotic Assembly
Forward TransformationTransforms homogeneous coordinates from tool frame to
reference frame coordinates
Inverse TransformationTransform homogeneous coordinate from reference frame to
tool frame coordinates
sbase = Atoolbasestool
= AwaistAshoulderAelbowAwrist−bendA flangeAwrist−twiststool
stool = Abasetool sbase
= A−1wrist−twistA
−1flangeA
−1wrist−bendA
−1elbowA
−1shoulderA
−1waistsbase
55
55
Deep Impact 1
56
56
2/12/20
29
Deep Space 1 Flyby and ImpactorSpacecraft
57
57
Deep Space 1 Encounter Scenario
58
• Impactor mass = 370 kg
• Impact velocity = 10 km/s+
58
2/12/20
30
Impactor Characteristics
59
§ Image data volume: § 17 MB (~35 images)
§ Pointing accuracy: § 3σ = 2 mrad
§ Energy storage for 24-hr mission: § 28 KWh
§ Propulsion/RCS:§ 25 m/s divert, 1750 N-s impulse
59
Deep Space 1 Autonomous Navigation and Targeting
• Flyby spacecraft comes within 500 km of Tempel 1comet, observes impact event for 800 s
• Impactor guided toward comet nucleus by AutoNav software (s/w)
• Identical attitude determination and control (ADCS) s/w in Flyby and Impactor
• Impactor Targeting Sensor (ITS) commands images every 15 sec
• “Scripted Autonomy”
60
Mastrodemos, Kubitschek, Synnott, JPL, 2005
60
2/12/20
31
Flyby Flight Control System§ Two RAD750 computers§ Medium Resolution Imager (MRI) for autonomous
navigation during encounter§ High Resolution Imager (HRI) for approach phase
optical navigation§ Power to both s/c while attached§ High-gain antenna for data return§ S-band antenna for communication with Impactor§ 3-axis momentum wheel attitude control§ 4 RCS thrusters for divert and momentum dumps§ Star Tracker/Inertial Reference Unit (SSIRU)
61
Mastrodemos, Kubitschek, Synnott, JPL, 2005
61
Impactor Flight Control System• Battery power for 24-hr operation• One RAD750 computer• SSIRU• Simple ITS• Divert/RCS thrusters• AutoNav components– Image processing– Orbit determination– Maneuver computation
62
Mastrodemos, Kubitschek, Synnott, JPL, 2005
62
2/12/20
32
Impactor Targeting Strategy• Options
– Proportional Navigation• Measurement of closing velocity
and line-of-sight angular rates• “Reduced dynamic approach”
– Predictive Guidance• Equations of motion for target
and interceptor• State estimation (“filtering”), like
SLAM
63
Mastrodemos, Kubitschek, Synnott, JPL, 2005
• Selected: Predictive, Pulsed Guidance to desired location on target
• Best quality observations obtained during non-thrusting periods
63
Impactor Targeting Strategy• Large uncertainty in knowledge of prior
position reduced via optical navigation• Nucleus rotation rate and solar phase angle
induce motion in center of brightness (CB)
64
• Mitigated by batch filtering process and selection of 20-min data arc length
Mastrodemos, Kubitschek, Synnott, JPL, 2005
64
2/12/20
33
Autonomous Navigation• AutoNav modes
– Star-relative mode– Star-less mode based on ADCS only and camera alignment
• Autonomous guidance process1) Timpact – 2 hr: Acquire comet nucleus images every 15 sec2) Compute pixel/line location of CB3) Compute measurement error4) Perform trajectory observation (OD) updates every min5) Perform 3 Impactor targeting maneuvers (ITM), at Timpact –
100 min, Timpact – 35 min, Timpact – 7.5 min6) Compute scene-analysis-based offset prior to 3rd ITM7) Timpact – 4 min: Point ITS along estimated comet-relative
velocity vector8) Flyby maintains tracking of impact point
65
Mastrodemos, Kubitschek, Synnott, JPL, 2005
65
Trajectory Determination• Updated once per minute for last 2 hr• Sequential batch processing updates
position, velocity, navigation line-of-sight attitude bias drift errors
• 80 observations in each 20-min arc• Time series of Impactor position relative to
the nucleus predicted with Chebyshevpolynomial (i.e., smooth extrapolation of prior position estimates)
66
Mastrodemos, Kubitschek, Synnott, JPL, 2005
66
2/12/20
34
Impactor Targeting Maneuvers (ITM)• Initiated via AutoNav sequence command• Required impulsive maneuver ΔV magnitude and
direction calculated• Finite-burn start time computed, tstart• Integration of accelerometer data indicates when ΔV
has been reached, and burn is terminated, tfinish• ITM-1 removes Flyby pre-release delivery errors (~6
km), requiring ΔV ~ 1 m/s• ITM-2 improves targeting, requiring ΔV ~ 11 cm/s• ITM-3 refines fine targeting of illuminated nucleus
based on CB observations, requiring ΔV ~ 7m/s– B-plane correction of as much as 4 km– Accurate to ~ 54 m
67
Mastrodemos, Kubitschek, Synnott, JPL, 2005
67
Expected Targeting Error
68
Mastrodemos, Kubitschek, Synnott, JPL, 2005
68
2/12/20
35
Expected Targeting Error
69Mastrodemos, Kubitschek, Synnott, JPL, 2005
69
Next Time:Human Factors of
Spaceflight
70
70
2/12/20
36
Supplemental Material
71
71
MSL Descent
72
72
2/12/20
37
73
ARES Data Handling and Processing System
73
Links Involving Prismatic JointsType 6 LinkIntersecting revolute and prismatic joints
McKerrow, 1991
Type 5 Link Intersecting prismatic joints
• Link n extends along zn-1 axis• ln = 0, along xn-1• dn = length, along zn-1 (variable)• θn = 0, about zn-1• αn = fixed orientation of n + 1
prismatic axis about xn-1
• Link n extends along zn-1 axis• ln = 0, along xn-1• dn = length, along zn-1 (fixed)• θn = variable joint angle n
about zn-1
• αn = fixed orientation of n + 1prismatic axis about xn-1
74
74
2/12/20
38
Two-Link/Three-Joint Manipulator
Assignment of coordinate frames
Manipulator in zero position
Parameters and Variables for 2-link manipulator
McKerrow, 1991
• Link lengths (fixed)• Joint angles (variable)
Parallel Rotation Axes
Workspace
75
75
Denavit-Hartenberg Representation of Joint-Link-Joint Transformation
• Like Euler angle rotation, transformational effects of the 4 link parameters are defined in a specific application sequence(right to left): {θ, d, l, α }
• 4 link parameters– Angle between 2 links, θ (revolute)– Distance (offset) between links, d
(prismatic)– Length of the link between rotational
axes, l, along the common normal (prismatic)
– Twist angle between axes, α (revolute)
An = A zn−1,θn( )A zn−1,dn( )A xn−1,ln( )A xn−1,α n( )= Rot(zn−1,θn ) Trans(zn−1,dn ) Trans(xn−1,ln ) Rot(xn−1,α n )! nTn+1 in some references (e.g., McKerrow, 1991)
Denavit-Hartenberg Demohttp://www.youtube.com/watch?v=10mUtjfGmzw
76
76
2/12/20
39
Four Transformations from One Joint to the Next
(Single Link)
�
Rot(zn−1,θn ) =
cosθn −sinθn 0 0sinθn cosθn 0 00 0 1 00 0 0 1
⎡
⎣
⎢ ⎢ ⎢ ⎢
⎤
⎦
⎥ ⎥ ⎥ ⎥
Trans(zn−1,dn ) =
1 0 0 00 1 0 00 0 1 dn0 0 0 1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥
�
Trans(xn−1,ln ) =
1 0 0 ln0 1 0 00 0 1 00 0 0 1
⎡
⎣
⎢ ⎢ ⎢ ⎢
⎤
⎦
⎥ ⎥ ⎥ ⎥
�
Rot(xn−1,αn ) =
1 0 0 00 cosαn −sinαn 00 sinαn cosαn 00 0 0 1
⎡
⎣
⎢ ⎢ ⎢ ⎢
⎤
⎦
⎥ ⎥ ⎥ ⎥
Rotation of θn about the zn-1 axis
Rotation of αn about the xn-1 axisTranslation of ln along the xn-1 axis
Translation of dn along the zn-1 axis
77
77
Example: Denavit-HartenbergRepresentation of Joint-Link-Joint
Transformation for Type 1 Link
An =
cosθn − sinθn cosαn sinθn sinαn ln cosθn
sinθn cosθn cosαn − cosθn sinαn ln sinθn
0 sinαn cosαn dn0 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
θ 30 degd = 0 ml = 0.25 mα = 90 deg
Joint Variable = θn
An =
cosθn 0 sinθn 0.25cosθn
sinθn 0 − cosθn 0.25sinθn
0 1 0 00 0 0 1
⎡
⎣
⎢⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥⎥
θ = variabled = 0 ml = 0.25 mα = 90 deg
An =
0.866 0 0.5 0.2170.5 0 −0.866 0.1250 1 0 00 0 0 1
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥
78
78
2/12/20
40
Matrix Inverse Identity Given: a square matrix, A, and its inverse, B
A =A1m×m
A2m×n
A3n×m
A4n×n
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥; B A−1 =
B1 B2B3 B4
⎡
⎣⎢⎢
⎤
⎦⎥⎥
AB = AA−1 = Im+n
=Im 00 In
⎡
⎣⎢⎢
⎤
⎦⎥⎥=
A1B1 +A2B3( ) A1B2 +A2B4( )A3B1 +A4B3( ) A3B2 +A4B4( )
⎡
⎣
⎢⎢
⎤
⎦
⎥⎥
Then
Equating like parts, and solving for Bi
B1 B2B3 B4
⎡
⎣⎢⎢
⎤
⎦⎥⎥=
A1 − A2A4−1A3( )−1 −A1
−1A2 A4 − A3A1−1A2( )−1
−A4−1A3 A1 − A2A4
−1A3( )−1 A4 − A3A1−1A2( )−1
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥
79
79
Forward and Inverse Kinematics Between Joints, Tool Position, and Tool Orientation
Forward Kinematic Problem: Compute the position of the tool in the reference frame that corresponds to a given joint vector (i.e., vector of link variables)
Inverse Kinematic Problem: Find the vector of link variablesthat corresponds to a desired task-dependent position
sbase = AwaistAshoulderAelbowAwrist−bendA flangeAwrist−twiststool = Atoolbasestool
To Be Determined ⇐Given
AwaistAshoulderAelbowAwrist−bendA flangeAwrist−twiststool = Atoolbases0 = sbase
To Be Determined ⇐ Given80
80