- Scientia Magna international journal, Vol. 4 No. 3
- Alain Goriely and Michael Tabor- Nonlinear Dynamics of Filaments III: Instabilities of Helical Rods
- IPC2012-90434
- Tutoring Questions
- Ch1 Revised
- Tensile Structures
- nirenberg.pdf
- radius of curvature of cartesian nd polar curves
- CLS Aipmt 16 17 XI Phy Study Package 1 SET 1 Chapter 4
- Tortuous Curves Review
- ScientiaMagna4no3-book
- PHY 130 - Chapter 2 -Kinematics in One Dimension
- Chapters Physics Basic tics
- Lecture Outlines Chapter 2
- dif4
- PUC Physics Question Bank
- 6-1970_ApplPhysL_423_paper
- Phy- Motion Graph Analysis
- e_SPEL+Ref73_r3
- 3-KINEMATICS -NOTES
- Understanding Space Time
- free fall lab
- 2.1 Analysing Linear Motion
- 1_Kinematics
- NCERT Ph 1 Motion Plane
- Lecture 2
- Research on Address Physics Study Problems
- 20320130406023
- MONT 2
- Aerial Robotics Lecture 1B_5 Agility and Manoeuvrability
- orisinalitas jurnal (1)
- 06. Wireless Networks
- Martijn Moraal 0131903 Massive Multiplayer Online Game ArchitecturesThe Best
- Filan Audio Proceing
- The Genius Hacking Untuk Membobol Facebook Dll
- z1453345120390245be6dfceb2a5997af1500b2588f
- Yudas Ktlh(1)
- 4.Algoritma Kriptografi Klasik (Bag 1)
- Template Xiaomi Klik! Cell
- pulsa klik!cell
- Nabi Khidir
- 1291-3051-1-PB
- Aplikasi MatLab.pdf
- Bilaniuk Fast LBP Face 2014 CVPR Paper
- 2012-1-00192-if ringkasan
- 13574039-basic-image-processing-matlab.pdf
- Belajar-Java-Dasar.pdf
- Kelompok 6_Project Human Resource Management.pptx
- Resume Motion&Trajectory
- 14 Grafkom Pendeteksian Tepi.pdf
- cv-template-Marketing-Manager.doc

Trajectory planning

in Cartesian space

Prof. Alessandro De Luca

Robotics 1

1

**Trajectories in Cartesian space
**

**in general, the trajectory planning methods proposed in the
**

joint space can be applied also in the Cartesian space

**consider independently each component of the task vector (i.e., a
**

position or an angle of a minimal representation of orientation)

**however, when planning a trajectory for the three
**

orientation angles, the resulting global motion cannot be

intuitively visualized in advance

if possible, we still prefer to plan Cartesian trajectories

separately for position and orientation

the number of knots to be interpolated in the Cartesian

space is typically low (e.g., 2 knots for a PTP motion, 3 if a

“via point” is added) ⇒ use simple interpolating paths, such

as straight lines, arc of circles, …

Robotics 1

2

pi .. . = σ L 3 . . dp .1] . vf (typically = 0) L pf L = ║pf .pi) s ds2 ds pf . 2 dp .pi = unit vector of directional cosines of the line ║pf . pf.L] is the arc length (gives the current length of the path) .pi) s ds pf . p(s) = s = (pf ... vmax. amax vi..pi║ path parameterization p(s) = pi + s (pf .Planning a linear Cartesian path (position only) pi GIVEN pi.pi║ setting s = σ/L. d2p .pi . = σ L Robotics 1 pf . σ ∈ [0.pi) s ∈ [0. p(s) = s + s = (pf .

coast.Ts) = L vmax Ts -1 t = area of the speed profile vmax Ts = amax L amax + vmax2 T= amaxvmax a “coast” phase exists iff: L > vmax2/amax * = other input data combinations are possible (see textbook) Robotics 1 4 .bang t .. T Vmax (T .Timing law with trapezoidal speed . vmax. σ(t) amax bang. amax find: Ts. σ(t) t L σ(t) T-Ts T given*: L.

.Timing law with trapezoidal speed . σ(t) amax amax t2/2 t σ(t) = .T] σ(t) Ts vmax vmax2 t2 amax -2 t can be used also in the joint space! 5 . σ(t) vmax t L Robotics 1 T-Ts T t ∈ [0.Ts] t ∈ [Ts.amax (t-T)2/2 + vmax vmax2 Tamax t ∈ [T-Ts.T-Ts] .

B y ║C . it is a planar problem) Robotics 1 6 . the path remains always in the plane specified by the two lines intersecting at B (in essence. ΔT] (transition starts at t = 0) note: during over-fly.A║ C’ A’ A x over-fly B.A C C.B║ = KAB = KBC unit vectors of direction cosines given: constant speeds v1 on linear path AB v2 on linear path BC desired transition: with constant acceleration for a time ΔT x(t) p(t) = y(t) z(t) t ∈ [0.Concatenation of linear paths z B =“via point” no need to pass (and stop!) there ║B .

y(t) v2 KBC.x v1 KAB.. x(t) . x(t) v2 KBC.z t ΔT Robotics 1 t 7 . z(t) v1 KAB..y t ..y v1 KAB. z(t) ΔT t t t . y(t) .Time profiles on components .z v2 KBC.x .

B y A x ║B .B║ t ∈ [0.v1 KAB) = KAB = KBC ║C .Timing law during transition z B B. p(t) = v1 KAB + t/ΔT (v2 KBC . p(t) = 1/ΔT (v2 KBC . ΔT] (transition starts at t = 0) ⌠ ⌡ .v1 KAB) Robotics 1 unit vectors of direction cosines thus.A C’ A’ C C..A║ x(t) p(t) = y(t) z(t) .v1 KAB) ⌠ ⌡ p(t) = A’ + v1 KAB t + t2/2ΔT (v2 KBC . we obtain a parabolic blending (see textbook for this same approach in the joint space) 8 .

v1 KAB) p(ΔT) = A’ + ΔT/2 (v1 KAB + v2 KBC) = C’ . d1 (namely A’) Robotics 1 d2 = v2 ΔT/2 ΔT = 2d1/v1 d2 = d1 v2/v1 9 .B + A’ + ΔT/2 (v1 KAB + v2 KBC) = C’ .g.B 1 d1 KAB + d2 KBC = ΔT/2 (v1 KAB + v2 KBC) d1 = v1 ΔT/2 by choosing. e.B = d2 KBC C’ C A’ A 1 p(t) = A’ + v1 KAB t + t2/2ΔT (v2 KBC .Solution (various options) d1 B B ..A’= d1 KAB d2 C’ .

3) to C=(8.9) via B=(1.A numerical example transition from A=(3.9). with speed from v1=1 to v2=2 exploiting two options for solution (resulting in different paths!) assign transition time: ΔT=4 (we re-center it here for t ∈ [-ΔT/2. ΔT/2]) assign distance from B for departing: d1=3 (assign d2 for landing is handled similarly) B C B C A’ A A ΔT=4 Robotics 1 d1=3 10 .

the same vel/acc profiles only with a different time scale!! Robotics 1 11 .A numerical example (cont’d) first option: ΔT=4 (resulting in d1=2. d2=4) second option: d1=3 (resulting in ΔT=6. d2=6) actually.

KBC.zKAB.Alternative solution (imposing acceleration) B .KAB║ = (vmax /amax) √ 2 (1 . ║p(t)║ = amax ΔT = (vmax /amax) ║KBC . d1 = d2 = vmax ΔT/2 Robotics 1 12 .z) then.y .v1 KAB) C’ A’ A C v1 = v2 = vmax (for simplicity) .yKAB.KBC... p(t) = 1/ΔT (v2 KBC .xKAB.x .KBC.

amax + over-fly between A” e C” 13 .Application example plan a Cartesian trajectory from A to C (rest-to-rest) that avoids the obstacle O. with a ≤ amax and v ≤ vmax add a via point B “sufficiently far” from O B C” A” A’ O C’ C A on AA’ → amax Robotics 1 on A’B and BC’ → vmax on C’C → .

with s = Rθ for circular paths). so that velocity: dp/dt = dp/ds · ds/dt dp/ds = unit vector (║·║=1) tangent to the path: tangent direction t(s) ds/dt = absolute value of tangential velocity (= speed) acceleration: d2p/dt2 = d2p/ds2 · (ds/dt)2 + dp/ds · d2s/dt2 Robotics 1 ║d2p/ds2║ = curvature κ(s) (= 1/radius of curvature) d2p/ds2·(ds/dt)2 = centripetal acceleration: normal direction n(s) ⊥ to the path..g. binormal direction b(s) = t(s) × n(s) d2s/dt2 = scalar value (with any sign) of tangential acceleration 14 . with a common timing law though more complex in general.Other Cartesian paths circular path through 3 points in 3D (often built-in feature) linear path for the end-effector with constant orientation in robots with spherical wrist: planning can be decomposed into a path for wrist center and one for E-E orientation. on the osculating plane. it is often convenient to parameterize the Cartesian geometric path p(s) in terms of its arc length (e.

Definition of Frenet frame For a generic (smooth) path p(s) in R3.t. one can define a reference frame as in figure p’ = dp/ds p’’ = d2p/ds2 derivatives w. parameterized by s (not necessarily its arc length).r. the parameter b(s) n(s) s t(s) t(s) = p’(s)/║p’(s)║ unit tangent vector n(s) = p’’(s)/║p’’(s)║ unit normal vector (∈ osculating plane) b(s) = t(s) × n(s) unit binormal vector general expression of path curvature (at a path point p(s)) κ(s) = ║p’(s) × p’’(s)║/║p’(s)║3 Robotics 1 15 .

Optimal trajectories for Cartesian robots (e.g. the straight line joining two position points in the Cartesian space is one path that can be executed in minimum time under velocity/acceleration constraints (but other such paths may exist. if (joint) motion can also be not coordinated) 2. actual ones on actuator torques.r. but time-optimality still holds in the joint space when assuming bounds on joint velocity/acceleration straight line paths in the joint space do not correspond to straight line paths in the Cartesian space. different torque values are needed to impose the same joint accelerations Robotics 1 16 .t. the optimal timing law is of the bang-coast-bang type in acceleration (in this special case. and vice-versa bounds on joint acceleration are conservative (though kinematically tractable) w. also in terms of actuator torques) for articulated robots (with at least a R joint) 1. which involve the robot dynamics when changing robot configuration/state.. are no longer true in general in the Cartesian space. e 2. PPP joints) 1.

ψ).θ. we can plan independently a trajectory for each component zA e.g. ZXZ Euler angles φ.. with a cubic timing law ⇒ but poor prediction/understanding of the resulting intermediate orientations alternative method: based on the axis/angle representation determine the (neutral) axis r and the angle θAB: R(r.. RAR(r.θ(t)) specifies then the actual end-effector orientation at time t Robotics 1 17 . a linear path in space φ θ ψ.Planning orientation trajectories A xA yA zB xB B yB using minimal representations of orientation (e.θAB) = RAT RB (rotation matrix changing the orientation from A to B ⇒ inverse axis-angle problem) plan a timing law θ(t) for the (scalar) angle θ interpolating 0 with θAB (with possible constraints/boundary conditions on its time derivatives) ∀t.g.

r.. there will be (at least) one instant of saturation (for at least one variable) no need to re-compute motion profiles from scratch after the scaling! 18 . scale (increase) time T → kT (k>1). by using a bang-coast-bang acceleration timing law velocity scales linearly with motion time dp/dt = dp/ds·ds/dτ·1/T acceleration scales quadratically with motion time 2 2 2 2 2 2 2 2 d p/dt = (d p/ds ·(ds/dτ) + dp/ds·d s/dτ )·1/T if motion is unfeasible. we need to check if existing bounds vmax on (joint) velocity and/or amax on (joint) acceleration are violated or not … unless such constraints have already been taken into account during the trajectory planning.g.Uniform time scaling for a given path p(s) (in joint or Cartesian space) and a given timing law s(τ) (τ=t/T. e. after scaling. T=“motion time”). based on the “most violated” constraint (max of the ratios |v|/vmax and |a|/amax) if motion is “too slow” w. the robot capabilities. decrease T (k<1) Robotics 1 in both cases.t.

1= 2.s ≈3 [m/s] max p1 path length L=2.2= 7 [rad/s2] . vmax. 0) [m] to p1=(0.816. 1. max (absolute) acceleration amax. 140°) ⇒ p0=f(q0)=(-. with rest-to-rest cubic timing law s(t).Numerical example -1 2R planar robot with links of unitary length (1 [m]) linear Cartesian path p(s) from q0=(110°. amax.4).5 [rad/s].0518 [m] zero initial and final speed q0 p0 s=s(t) non-zero (symmetric) acceleration T=1 Robotics 1 19 .1= 5.2= 2. T=1 [s] bounds in joint space: max (absolute) velocity vmax.684.

898 > T = joint 1 Robotics 1 = joint 2 20 .Numerical example violation of both joint velocity and acceleration bounds with T=1 [s] -2 max relative violation of joint velocities: kvel = 2. kvel .898 ⇒ Tscaled = kT = 2.898 max relative violation of joint accelerations: kacc = 6. √kacc} = 2.2567 minimum uniform time scaling of Cartesian trajectory to recover feasibility k = max {1.

Numerical example -3 scaled trajectory with Tscaled = 2.898 [s] speed [acceleration] on path and joint velocities [accelerations] scale linearly [quadratically] traced Cartesian path and associated joint paths remain the same! at least 1 instant of saturation! Robotics 1 = joint 1 = joint 2 21 .

- Scientia Magna international journal, Vol. 4 No. 3Uploaded byscience2010
- Alain Goriely and Michael Tabor- Nonlinear Dynamics of Filaments III: Instabilities of Helical RodsUploaded byDopame
- IPC2012-90434Uploaded byMarcelo Varejão Casarin
- Tutoring QuestionsUploaded byJuliene
- Ch1 RevisedUploaded byPhi Tien Cuong
- Tensile StructuresUploaded byRicardo Urech
- nirenberg.pdfUploaded byEugenio Martinez
- radius of curvature of cartesian nd polar curvesUploaded bykaran338
- CLS Aipmt 16 17 XI Phy Study Package 1 SET 1 Chapter 4Uploaded byRaja Gopal
- Tortuous Curves ReviewUploaded byvishesharada
- ScientiaMagna4no3-bookUploaded byscience2010
- PHY 130 - Chapter 2 -Kinematics in One DimensionUploaded byainnajwa97
- Chapters Physics Basic ticsUploaded byarnabnitw
- Lecture Outlines Chapter 2Uploaded bysummersky6970
- dif4Uploaded byRamazan Soylemez
- PUC Physics Question BankUploaded bySathish Kumar
- 6-1970_ApplPhysL_423_paperUploaded byOMSURYACHANDRASIVA
- Phy- Motion Graph AnalysisUploaded byGkid Gkid
- e_SPEL+Ref73_r3Uploaded byJorge Resende
- 3-KINEMATICS -NOTESUploaded bynabiha137
- Understanding Space TimeUploaded byazharsuharwardi
- free fall labUploaded byapi-276545992
- 2.1 Analysing Linear MotionUploaded byped
- 1_KinematicsUploaded byMohd Shaan
- NCERT Ph 1 Motion PlaneUploaded bykdsiddhant
- Lecture 2Uploaded byMahesh Gahlot
- Research on Address Physics Study ProblemsUploaded byGkid Gkid
- 20320130406023Uploaded byIAEME Publication
- MONT 2Uploaded byAshish Ranjan
- Aerial Robotics Lecture 1B_5 Agility and ManoeuvrabilityUploaded byIain McCulloch

- orisinalitas jurnal (1)Uploaded byKrisandi Agusto
- 06. Wireless NetworksUploaded byKrisandi Agusto
- Martijn Moraal 0131903 Massive Multiplayer Online Game ArchitecturesThe BestUploaded byKrisandi Agusto
- Filan Audio ProceingUploaded byKrisandi Agusto
- The Genius Hacking Untuk Membobol Facebook DllUploaded byKrisandi Agusto
- z1453345120390245be6dfceb2a5997af1500b2588fUploaded byKrisandi Agusto
- Yudas Ktlh(1)Uploaded byKrisandi Agusto
- 4.Algoritma Kriptografi Klasik (Bag 1)Uploaded byKrisandi Agusto
- Template Xiaomi Klik! CellUploaded byKrisandi Agusto
- pulsa klik!cellUploaded byKrisandi Agusto
- Nabi KhidirUploaded byKrisandi Agusto
- 1291-3051-1-PBUploaded byKrisandi Agusto
- Aplikasi MatLab.pdfUploaded byKrisandi Agusto
- Bilaniuk Fast LBP Face 2014 CVPR PaperUploaded byKrisandi Agusto
- 2012-1-00192-if ringkasanUploaded byKrisandi Agusto
- 13574039-basic-image-processing-matlab.pdfUploaded byKrisandi Agusto
- Belajar-Java-Dasar.pdfUploaded byKrisandi Agusto
- Kelompok 6_Project Human Resource Management.pptxUploaded byKrisandi Agusto
- Resume Motion&TrajectoryUploaded byKrisandi Agusto
- 14 Grafkom Pendeteksian Tepi.pdfUploaded byKrisandi Agusto
- cv-template-Marketing-Manager.docUploaded byKrisandi Agusto