Conference PaperPDF Available

Computation of Relative Orbital Motion using Product of Exponentials Mapping

Authors:

Abstract

The Product of Exponentials (PoE) method consists of an exponential mapping commonly used in robotics. However, it can easily be adapted to describe the position and orientation of any rigid body in relation to another body or frame. In prior work, it was demonstrated that the PoE framework is useful as an alternative method for defining and drawing orbits given a set of orbital elements. This paper expands the application of the PoE framework to compute relative orbital motion. It proves to efficiently correlate the relative attitude and position between a chaser and a target using a compact formulation.
AAS 22-802
COMPUTATION OF RELATIVE ORBITAL MOTION USING
PRODUCT OF EXPONENTIALS MAPPING
Aryslan Malik*
, David Canales
, Taylor Yow
, Daniel Posada§
, Christopher W.
Hays§
, David Zuehlke§
, and Troy Henderson
The Product of Exponentials (PoE) method consists of an exponential mapping
commonly used in robotics. However, it can easily be adapted to describe the
position and orientation of any rigid body in relation to another body or frame. In
prior work, it was demonstrated that the PoE framework is useful as an alternative
method for defining and drawing orbits given a set of orbital elements. This paper
expands the application of the PoE framework to compute relative orbital motion.
It proves to efficiently correlate the relative attitude and position between a chaser
and a target using a compact formulation.
INTRODUCTION
Brockett’s study was the first to adopt the Product of Exponentials (PoE) formulation to express
forward kinematics of a multi-body system.1The PoE formulation’s core concept is to consider a
joint as a screw that moves the rest of the external links (or bodies), which allows for simultaneous
rotation and translation resulting in a concise mathematical formulation.2–7 The PoE has proven to
be useful for robotic control and manipulation.8–22 Recently, the PoE formulation was expanded to
“draw” orbits using each element of the Keplerian orbital elements set [Ω, i, ω, θ, r(θ)], where
each element acts as a separate joint.23 In this work, its application is expanded to the description
of relative orbital motion. The benefit of using PoE formulation is that the underlying matrices
defining rotation and translation are inverted, and therefore, using a succinct notation, the chaser’s
attitude and position is easily related to the target’s, and vice-versa.
The PoE-orbital mechanics framework relates a set of orbital elements ([Ω, i, ω, θ, r(θ)]) to the
full state (position, velocity) of the satellite (peo R3, Veo R3)using exponential mappings.23
Note that is the right ascension of the ascending node, iis the inclination of the orbit, ωis the
argument of periapsis, θis the true anomaly, and r(θ)is the location of the spacecraft defined as:
r(θ) = a(1 e2)
1 + ecos θ,(1)
*Visiting Assistant Professor, Space Technologies Lab, Embry-Riddle Aeronautical University, 1 Aerospace Blvd., Day-
tona Beach, FL, 32114.
Assistant Professor, Aerospace Engineering Department, Embry-Riddle Aeronautical University, Daytona Beach, FL,
32114.
Masters Student, Space Technologies Lab, Embry-Riddle Aeronautical University, 1 Aerospace Blvd., Daytona Beach,
FL, 32114.
§Ph.D. Candidate, Space Technologies Lab, Embry-Riddle Aeronautical University, 1 Aerospace Blvd., Daytona Beach,
FL, 32114.
Associate Professor, Space Technologies Lab, Embry-Riddle Aeronautical University, 1 Aerospace Blvd., Daytona
Beach, FL, 32114.
1
being athe semi-major axis and ethe eccentricity of the orbit. The position of a body frame
expressed in the inertial frame is calculated here leveraging a single PoE formula:
Teo =e[S1]Ωe[S2]ie[S3]ωe[S4]θe[S5]r(θ)Meo SE(3),(2)
where,
Meo =
1 0 0 0
0 1 0 0
0 0 1 0
0 0 0 1
=I4×4,(3)
S1=
0
0
1
0
0
0
,S2=
1
0
0
0
0
0
,S3=
0
0
1
0
0
0
,S4=
0
0
1
0
0
0
,S5=
0
0
0
1
0
0
.(4)
The configuration matrices Teo are part of SE (3), which is the Special Euclidean space that
preserves the Euclidean distance between any two points. Such an Euclidean space is described here
by 4×4matrices that store both attitude and position information, as shown in Eq. (6). The subscript
(eo)in Meo corresponds to the “home” configuration of an “object” relative to the equatorial frame
of the major body. The Meo is the 4×4identity matrix given that, initially, it is assumed that
the object’s position and orientation coincides with the equatorial frame’s position and orientation,
which is then modified by exponentials which allow the transformation of our object’s frame. Figure
1 represents the different reference frames used in this investigation: (xe, ye, ze)corresponds to
the geocentric equatorial frame, (xo, yo, zo)to the orbital perifocal frame, and (xb, yb, zb), to the
satellite body frame with xbpointing radially outwards, ybis in the direction of the velocity of the
satellite, and zbbeing normal to the orbital plane.
The inertial velocity of an object in orbit expressed in an inertial frame is given by the following
equation:
Vs=Reo
˙r(θ)
r(θ)˙
θ
0
=ReoVb,(5)
where Reo SO(3) is extracted from the configuration of the body,
Teo =Reo peo
0 1 SE (3).(6)
More generally, the inertial velocity of the body is calculated directly from the spatial twist, Vs
R6, as follows:
Vs=S1˙
+ Ade[S1]Ω (S2)˙
i+ Ade[S1]Ωe[S2]i(S3) ˙ω(7)
+ Ade[S1]Ωe[S2]ie[S3]ω(S4)˙
θ+ Ade[S1]Ωe[S2]ie[S3]ωe[S4]θ(S5) ˙r(θ),
where,
Vs=ωs
vsR6.(8)
2
b
ω
Orbit Plane Perigee
Equatorial Plane
Ascending Node
i
b
b
Satellite
r(ѳ)
ѳ
Figure 1. Representation of the different reference frames used in this study.
The adjoint operator is also defined as,
AdT=R03×3
[ˆp]R R ,(9)
with [ˆ
·]being the skew-symmetric operator defined in Eq. (10):
[ˆp] =
0p3p2
p30p1
p2p10
.(10)
Therefore, the velocity vector of the satellite expressed in the inertial frame becomes:
Vs=vs+ωs×peo R3.(11)
Alternatively, the inertial velocity may be computed from a body twist:
Vb=ωb
vb= AdT1
eo
VsR6,(12)
Vs=03×3ReoVb=Reo vbR3.(13)
Taking the inertial derivative of the position vector twice yields the inertial acceleration found in
Eq. 14.
As=¨r(θ)
r(θ)peo + ˙ωs×peo +2 ˙r(θ)
r(θ)ωs×peo +ωs×(ωs×peo)(14)
where ˙ωscan be either computed from the derivative of spatial twist in Eq. 7,
As=˙
Vs=˙ωs
˙vsR6,(15)
3
or from spatial twist and inertial velocity,
˙ωs=2Vs·peo
r2(θ)ωs.(16)
To this extent, the PoE formulation is extended in this paper to compute relative orbital motion.
Various relative motion and proximity operations are designed using PoE. The PoE method al-
lows transitioning from orbital elements that would incur particular relative motions. This fact
is accomplished by accommodating the exponentials formulation to the Clohessy-Wiltshire (CW)
equations.24 The resulting methodology could then be exploited for different applications, such as
servicing and proximity operations.
RELATIVE ORBITAL MOTION
The relative orbital motion problem considers two spacecraft operating within close proximity
of one another. The inertial position of the “target” spacecraft A is denoted as pet, and the inertial
position of the “chaser” spacecraft B is denoted as pec. The relative position of spacecraft A with
respect to spacecraft B in inertial frame (e)is denoted as the vector p(e)
ct =pet pec.
Target A
pet
pec
t
t
t
Inertial Frame
pct
Chaser B
Figure 2. Co-moving reference frame attached to target A, from which body B is observed
Relative motion in orbit usually involves a target spacecraft, which is most of the time passive
and non-maneuvering, and a chaser spacecraft, which is active and performs maneuvers to bring
itself closer to the target in a specific orientation. The configuration of the target spacecraft with
respect to the geocentric equatorial frame is denoted by Tet, such that:
Tet =Ret pet
0 1 SE (3).(17)
where, Ret SO(3) is the orientation and pet R3is the position of the target spacecraft expressed
in geocentric equatorial frame.
4
Similarly, the chaser spacecraft’s configuration is expressed using SE(3) configuration matrix:
Tec =Rec pec
0 1 SE(3).(18)
These configuration matrices can be directly computed from the orbital elements set using the PoE
formula, the following formula demonstrates this for the chaser spacecraft:
Tec =e[S1]Ωce[S2]ice[S3]ωce[S4]θce[S5]r(θ)cMec SE (3) (19)
The orientation of the target spacecraft expressed in chaser spacecraft’s frame is given by the fol-
lowing formula:
Rct = (Rec)1Ret SO(3) (20)
The result of Eq. 20 is a special orthogonal matrix SO(3) because an inverse of a rotation matrix
RSO(3) is also a rotation matrix, and the product of two rotation matrices is also a rotation
matrix. Now, similarly to rotation matrices, the transformation matrices possess the same properties
such that an inverse of a transformation matrix TSE(3) is also a transformation matrix:
T1=R p
0 11
=RTRTp
0 1 SE (3) (21)
Now, the configuration of the the target spacecraft with respect to the chaser can be computed using
the following equation:
Tct = (Tec)1Tet =RT
ecRet RT
ecpet RT
ecpec
0 1 ="Rct p(c)
ct
0 1 #SE(3) (22)
where, Rct is the orientation and p(c)
ct is the position of the target spacecraft expressed in chaser
spacecraft’s frame - that is how the observer on chaser spacecraft would see the target spacecraft.
Now, the relative velocity can be described using the developed tools. The first step is to compute
inertial velocities of the target Vtand chaser Vcspacecraft using either Eq. 5 or Eq. 11. Next, the
relative velocity of target spacecraft relative to chaser is computed as follows:
V(e)
ct =VtVcωc×(pet pec)(23)
where, ωcis the angular velocity of chaser spacecraft’s frame expressed in inertial frame, and is
computed from spatial twist using Eqs. 7 and 8. This inertial relative velocity as seen from chaser
spacecraft’s frame of reference is computed as:
V(c)
ct =RT
ecV(e)
ct (24)
Secondly, the relative accelerations may be computed as follows:
A(e)
ct =AtAc2ωc×(V(e)
ct )ωc×ωc×(pet pec)˙ωc×pct (25)
where Atand Acare the inertial acceleration terms of the target and chaser, respectively. Each of
these terms are calculated using the method presented in our work.25 The relative acceleration term
may also be rotated into the chaser spacecraft’s frame of reference:
A(c)
ct =RT
ecA(e)
ct (26)
5
To validate the developed relative orbit PoE formulation, an example problem from a textbook
was used.26 The chaser and target orbits are described in Table 1. The orbits are visualized in Figure
3. The relative motion of spacecrafts was simulated for 60 orbital periods of the chaser spacecraft
with starting true anomaly of 40. The relative position of the target spacecraft expressed in inertial
frame is shown on the left of Figure 4, which is not very intuitive to visualize. The same relative
position expressed in the chaser frame is shown on the right of Figure 4, where the chaser’s LVLH
frame is shown in black, and the target’s position with respect to chaser when t= 0 is shown in
green. Relative velocity V(e)
ct and acceleration A(e)
ct expressed in inertial frame was calculated using
Eqs. 23 and 25, respectively, and plotted by components in Figure 5.
The proposed PoE approach produced relative position, velocity, and acceleration vectors that
were in agreement with those obtained using traditional techniques. Figure 6 demonstrates the error
in the relative position of the target expressed in chaser frame when comparing the output of the
proposed PoE method and an example code in Curtis Matlab library. All of the error components
are cyclic and remain consistent indicating that the culprit of the insignificant difference is purely
numerical (e.g. round-off) - the magnitude of the error does not exceed 0.3 mm.
Table 1. Description of Orbits
Orbital Element Chaser Orbit Target Orbit
a6803 km 6878 km
e0.0257 0.0073
i6050
ω30120
4040
Figure 3. Chaser and target orbits, with Earth scaled to 80%
6
Figure 4. Relative position of target with respect to chaser spacecraft expressed in
inertial p(e)
ct (left) and chaser p(c)
ct (right) frames
Figure 5. Relative velocity V(e)
ct (left) and acceleration A(e)
ct (right) expressed in inertial frame
Figure 6. Relative errors in relative position expressed in chaser frame p(c)
ct when
comparing the output based on PoE and Curtis’s Matlab library,26 simulated for 60
orbital periods of chaser
7
CONCLUSIONS AND FUTURE WORK
This work approached the relative orbital motion problem using orbital differences within the
PoE framework. The relative position and orientations were described using SE (3) configuration
matrices, and relative velocity and acceleration were developed using spatial twist and spatial ac-
celeration. The presented approach was validated by comparing the output of the PoE method with
the classical approach outlined in Curtis’s work. The results of the comparison demonstrate that the
proposed method is in good agreement with traditional methods.
The main advantage of using the PoE-orbital mechanics framework presented in this investigation
lies in its unified approach of describing both the relative position and orientation using a single
formula. This elegant and concise formulation comes from the existence of an analytical inverse of
the SE (3) configuration matrices (e.g. T1
eo ). Furthermore, because PoE is inherently a geometric
approach, singularities within the equations of motion or its parameterization do not exist.
Lastly, the presented PoE-orbital mechanics framework allows all orbital elements to vary with
respect to time while still being able to calculate the state of a spacecraft. In future research, it is
planned to investigate the utility of this framework when modeling different sources of orbit decay
and perturbations, such as J2 perturbations.
8
REFERENCES
[1] R. W. Brockett, “Robotic manipulators and the product of exponentials formula, Mathematical theory
of networks and systems, Springer, 1984, pp. 120–129.
[2] F. C. Park, “Computational aspects of the product-of-exponentials formula for robot kinematics, IEEE
Transactions on Automatic Control, Vol. 39, No. 3, 1994, pp. 643–647.
[3] K. M. Lynch and F. C. Park, Modern Robotics. Cambridge University Press, 2017.
[4] P. Tsiotras and J. M. Longuski, A new parameterization of the attitude kinematics, Journal of the
Astronautical Sciences, Vol. 43, No. 3, 1995, pp. 243–262.
[5] D. D. Holm, T. Schmah, and C. Stoica, Geometric mechanics and symmetry: from finite to infinite
dimensions, Vol. 12. Oxford University Press, 2009.
[6] J. M. Selig, “Lie groups and lie algebras in robotics,” Computational Noncommutative Algebra and
Applications, pp. 101–125, Springer, 2004, 10.1007/1-4020-2307-35.
[7] J. M. Selig, Geometric fundamentals of robotics. Springer Science & Business Media, 2004,
10.1007/978-1-4757-2484-4.
[8] C. He, S. Wang, Y. Xing, and X. Wang, “Kinematics analysis of the coupled tendon-driven robot based
on the product-of-exponentials formula, Mechanism and Machine Theory, Vol. 60, 2013, pp. 90–111,
10.1016/J.MECHMACHTHEORY.2012.10.002.
[9] A. Malik, T. Henderson, and R. J. Prazenica, “Trajectory generation for a multibody robotic system
using the product of exponentials formulation, AIAA Scitech 2021 Forum, 2021, p. 2016.
[10] F. C. Park, B. Kim, C. Jang, and J. Hong, “Geometric algorithms for robot dynamics: A tutorial review,
Applied Mechanics Reviews, Vol. 70, No. 1, 2018, 10.1115/1.4039078.
[11] A. Malik, Y. Lischuk, T. Henderson, and R. Prazenica, “Generating Constant Screw Axis Trajectories
With Quintic Time Scaling For End-Effector Using Artificial Neural Network And Machine Learning,”
2021 IEEE Conference on Control Technology and Applications (CCTA), IEEE, 2021, pp. 1128–1134.
[12] G. S. Chirikjian, “Discussion of “Geometric Algorithms for Robot Dynamics: A Tutorial Review”(FC
Park, B. Kim, C. Jang, and J. Hong, 2018, ASME Appl. Mech. Rev., 70 (1), p. 010803),” Applied
Mechanics Reviews, Vol. 70, No. 1, 2018, 10.1115/1.4039080.
[13] A. Malik, T. Henderson, and R. Prazenica, “Multi-Objective Swarm Intelligence Trajectory Generation
for a 7 Degree of Freedom Robotic Manipulator, Robotics, Vol. 10, No. 4, 2021, p. 127.
[14] A. M ¨
uller, An overview of formulae for the higher-order kinematics of lower-pair chains with applica-
tions in robotics and mechanism theory, Mechanism and Machine Theory, Vol. 142, 2019, p. 103594,
10.1016/J.MECHMACHTHEORY.2019.103594.
[15] J. J. Korczyk, D. Posada, A. Malik, and T. Henderson, “Modeling of an On-Orbit Maintenance Robotic
Arm Test-Bed, 2021 AAS/AIAA Astrodynamics Specialist Conference, 2021, pp. August 8–12, Big Sky,
USA.
[16] M. R. Pac and D. O. Popa, “Interval analysis of kinematic errors in serial manipulators using product
of exponentials formula, IEEE Transactions on Automation Science and Engineering, Vol. 10, No. 3,
2013, pp. 525–535, 10.1109/TASE.2013.2263384.
[17] A. Malik, “Trajectory Generation for a Multibody Robotic System: Modern Methods Based on Product
of Exponentials,” Ph.D. Thesis, 2021.
[18] H. Wang, X. Lu, W. Cui, Z. Zhang, Y. Li, and C. Sheng, “General inverse solution of six-degrees-
of-freedom serial robots based on the product of exponentials model, Assembly Automation, 2018,
10.1108/AA-10-2017-122.
[19] A. Malik, Y. Lischuk, T. Henderson, and R. Prazenica, A Deep Reinforcement Learning Approach for
Inverse Kinematics Solution of a High Degree of Freedom Robotic Manipulator,” Robotics, Vol. 12,
No. 5, 2022, p. 130.
[20] C. Li, Y. Wu, H. L ¨
owe, and Z. Li, “POE-based robot kinematic calibration using axis configuration
space and the adjoint error model,” IEEE Transactions on Robotics, Vol. 32, No. 5, 2016, pp. 1264–
1279, 10.1109/TRO.2016.2593042.
[21] R. He, Y. Zhao, S. Yang, and S. Yang, “Kinematic-parameter identification for serial-robot calibra-
tion based on POE formula,” IEEE Transactions on Robotics, Vol. 26, No. 3, 2010, pp. 411–423,
10.1109/TRO.2010.2047529.
[22] G. Chen, H. Wang, and Z. Lin, “Determination of the identifiable parameters in robot calibration
based on the POE formula,” IEEE Transactions on Robotics, Vol. 30, No. 5, 2014, pp. 1066–1077,
10.1109/TRO.2014.2319560.
[23] A. Malik, T. Henderson, and R. J. Prazenica, “Using Products of Exponentials to Define (Draw) Orbits
and More,” Advances in the Astronautical Sciences, Vol. 175, 2021, p. 3319.
9
[24] W. Clohessy and R. Wiltshire, “Terminal guidance system for satellite rendezvous, Journal of the
Aerospace Sciences, Vol. 27, No. 9, 1960, pp. 653–658.
[25] T. Yow, C. W. Hays, A. Malik, and T. Henderson, “Orbital Acceleration Using Product of Exponentials,”
arXiv preprint, 2022.
[26] H. Curtis, Orbital mechanics for engineering students. Butterworth-Heinemann, 2013.
10
... This type of information is essential for estimating the attitude of a target during the monitoring and capture phases, as well as for controlling the object during the post-capture phase. [9]. ...
Thesis
Full-text available
Space is becoming increasingly congested every day and the task of accurately tracking satellites is paramount for the continued safe operation of both manned and unmanned space missions. In addition to new spacecraft launches, satellite break-up events and collisions generate large amounts of orbital debris dramatically increasing the number of orbiting objects with each such event. In order to prevent collisions and protect both life and property in orbit, accurate knowledge of the position of orbiting objects is necessary. Space Domain Awareness (SDA) used interchangeably with Space Situational Awareness (SSA), are the names given to the daunting task of tracking all orbiting objects. In addition to myriad objects in low-earth-orbit (LEO) up to Geostationary (GEO) orbit, there are a growing number of spacecraft in cislunar space expanding the task of cataloguing and tracking space objects to include the whole of the earth-moon system. This research proposes a series of algorithms to be used in autonomous SSA for earth-orbiting and cislunar objects. The algorithms are autonomous in the sense that once a set of raw measurements (images in this case) are input to the algorithms, no human in the loop input is required to produce an orbit estimate. There are two main components to this research, an image processing and satellite detection component, and a dynamics modeling component for three-body relative motion. For the image processing component, resident space objects, (commonly referred to as RSOs) which are satellites or orbiting debris are identified in optical images. Two methods of identifying RSOs in a set of images are presented. The first method autonomously builds a template image to match a constellation of satellites and proceeds to match RSOs across a set of images. The second method utilizes optical flow to use the image velocities of objects to differentiate between stars and RSOs. Once RSOs have been detected, measurements are generated from the detected RSO locations to estimate the orbit of the observed object. The orbit determination component includes multiple methods capable of handling both earth-orbiting and cislunar observations. The methods used include batch-least squares and unscented Kalman filtering for earth-orbiting objects. For cislunar objects, a novel application of a particle swarm optimizer (PSO) is used to estimate the observed satellite orbit. The PSO algorithm ingests a set of measurements and attempts to match a set of virtual particle measurements to the truth measurements. The PSO orbit determination method is tested using both MATLAB and Python implementations. The second main component of this research develops a novel linear dynamics model of relative motion for satellites in cislunar space. A set of novel linear relative equations of motion are developed with a semi-analytical matrix exponential method. The motion models are tested on various cislunar orbit geometries for both the elliptical restricted three-body problem (ER3BP) and the circular restricted three-body problem (CR3BP) through MATLAB simulations. The linear solution method's accuracy is compared to the non-linear equations of relative motion and are seen to hold to meter level accuracy for deputy position for a variety of orbits and time-spans. Two applications of the linearized motion models are then developed. The first application defines a differential corrector to compute closed relative motion trajectories in a relative three-body frame. The second application uses the exponential matrix solution for the linearized equations of relative motion to develop a method of initial relative orbit determination (IROD) for the CR3BP.
Article
Full-text available
The foundation and emphasis of robotic manipulator control is Inverse Kinematics (IK). Due to the complexity of derivation, difficulty of computation, and redundancy, traditional IK solutions pose numerous challenges to the operation of a variety of robotic manipulators. This paper develops a Deep Reinforcement Learning (RL) approach for solving the IK problem of a 7-Degree of Freedom (DOF) robotic manipulator using Product of Exponentials (PoE) as a Forward Kinematics (FK) computation tool and the Deep Q-Network (DQN) as an IK solver. The selected approach is architecturally simpler, making it faster and easier to implement, as well as more stable, because it is less sensitive to hyperparameters than continuous action spaces algorithms. The algorithm is designed to produce joint-space trajectories from a given end-effector trajectory. Different network architectures were explored and the output of the DQN was implemented experimentally on a Sawyer robotic arm. The DQN was able to find different trajectories corresponding to a specified Cartesian path of the end-effector. The network agent was able to learn random Bézier and straight-line end-effector trajectories in a reasonable time frame with good accuracy, demonstrating that even though DQN is mainly used in discrete solution spaces, it could be applied to generate joint space trajectories.
Article
Full-text available
This work is aimed to demonstrate a multi-objective joint trajectory generation algorithm for a 7 degree of freedom (DoF) robotic manipulator using swarm intelligence (SI)—product of exponentials (PoE) combination. Given a priori knowledge of the end-effector Cartesian trajectory and obstacles in the workspace, the inverse kinematics problem is tackled by SI-PoE subject to multiple constraints. The algorithm is designed to satisfy finite jerk constraint on end-effector, avoid obstacles, and minimize control effort while tracking the Cartesian trajectory. The SI-PoE algorithm is compared with conventional inverse kinematics algorithms and standard particle swarm optimization (PSO). The joint trajectories produced by SI-PoE are experimentally tested on Sawyer 7 DoF robotic arm, and the resulting torque trajectories are compared.
Article
Full-text available
The motions of mechanisms can be described in terms of screw coordinates by means of an exponential mapping. The product of exponentials (POE) describes the configuration of a chain of bodies connected by lower pair joints. The kinematics is thus given in terms of joint screws. The POE serves to express loop constraints for mechanisms as well as the forward kinematics of serial manipulators. Besides the compact formulations, the POE gives rise to purely algebraic relations for derivatives wrt. joint variables. It is known that the partial derivatives of the instantaneous joint screws (columns of the geometric Jacobian) are determined by Lie brackets the joint screws. Lesser-known is that derivative of arbitrary order can be compactly expressed by Lie brackets. This has significance for higher-order forward/inverse kinematics and dynamics of robots and multibody systems. Various relations were reported but are scattered in the literature and insufficiently recognized. This paper aims to provide a comprehensive overview of the relevant relations. Its original contributions are closed form and recursive relations for higher-order derivatives and Taylor expansions of various kinematic relations. Their application to kinematic control and dynamics of robotic manipulators and multibody systems is discussed.
Article
Full-text available
The product of exponential model based robot calibration approach eliminates parameter discontinuity and simplifies coordinate frame setup, but demands extra effort to normalize twist coordinates and differentiate parameter-varying exponential maps. In this paper, we show that such an endeavor can be exempted by respecting the nonlinear geometry of the joint axis configuration space (ACS), the set of all possible axis locations. We analyze the geometry of the ACS models for prismatic and revolute joints, and treat the errors as Adjoint transformations on joint twists. We propose a novel robot kinematic calibration algorithm based on the ACS and Adjoint error model. It is geometrically intuitive, computationally efficient, and can easily handle additional assumptions on joint axes relations. We present a comparative study with simulations and experiments to show that our algorithm outperforms the existing ones in various aspects.
Conference Paper
This paper presents a trajectory generation algorithm for multibody robotic systems based on the Product of Exponentials (PoE) formulation, also known as screw theory. A PoE formulation is first developed to model the kinematics and dynamics of a multibody robotic manipulator with 7 revolute joints and an end effector. An inverse kinematic algorithm based on the Newton-Raphson iterative method is then applied to generate constrained joint-space trajectories corresponding to straight-line motion of the end effector in Cartesian space with finite jerk. Derivatives of these joint-space trajectories are computed using Bézier curves, which ensures dynamically feasible trajectories. A novel method of Mean Arctangent Absolute Percentage Error (MAAPE) is then used to check accuracy of the derivatives of joint-space trajectories. The Newton-Euler recursive algorithm is then implemented to compute the inverse dynamics, which generates the joint torques required to achieve the reference trajectories. These torques are then incorporated into a closed-loop control algorithm, and simulation studies are performed using a dynamic model of the robotic system. The simulation results demonstrate that the proposed approach is able to successfully generate constrained trajectories, the MAAPE shows that lower order Bézier curves approximate the joint-space derivatives with the same accuracy as higher order polynomials, and the closed-loop controller provides accurate trajectory tracking subject to model uncertainties. This algorithm can be used to generate trajectories for robotic arms performing spacecraft servicing missions, because it also takes into account the variable gravity vector. The significant contribution of this method is integration of all of these techniques applied to a multibody robotic system.
Article
Purpose Developing general closed-form solutions for six-degrees-of-freedom (DOF) serial robots is a significant challenge. This paper thus aims to present a general solution for six-DOF robots based on the product of exponentials model, which adapts to a class of robots satisfying the Pieper criterion with two parallel or intersecting axes among its first three axes. Design/methodology/approach The proposed solution can be represented as uniform expressions by using geometrical properties and a modified Paden–Kahan sub-problem, which mainly adopts the screw theory. Findings A simulation and experiments validated the correctness and effectiveness of the proposed method (general resolution for six-DOF robots based on the product of exponentials model). Originality/value The Rodrigues rotation formula is additionally used to turn the complex problem into a solvable trigonometric function and uniformly express six solutions using two formulas.
Article
Lie-theoretic methods provide an elegant way to formulate many problems in robotics, and the tutorial by Park et al. (2018, “Geometric Algorithms for Robot Dynamics: A Tutorial Review,” ASME Appl. Mech. Rev., 70(1), p. 010803) is simultaneously a complete and concise introduction to these methods as they pertain to robot dynamics. The central reason why Lie groups are a natural mathematical tool for robotics is that rigid-body motions and pose changes can be described as Lie groups, and allow phenomena including robot kinematics and dynamics to be formulated in elegant notation without introducing superfluous coordinates. The emphasis of the tutorial by Park et al. (2018, “Geometric Algorithms for Robot Dynamics: A Tutorial Review,” ASME Appl. Mech. Rev., 70(1), p. 010803) is robot dynamics from a Lie-theoretic point of view. Newton–Euler and Lagrangian formulation of robot dynamics algorithms with O(n) complexity were formulated more than 35 years ago using recurrence relations that use the serial structure of manipulator arms. This was done without using the knowledge of Lie theory. But issues such as why the x terms in rigid-body dynamics appear can be more easily understood in the context of this theory. The authors take great efforts to be understandable by nonexperts and present extensive references to the differential-geometric and Lie-group-centric formulations of manipulator dynamics. In the discussion presented here, connections are made to complementary methods that have been developed in other bodies of literature. This includes the multibody dynamics, geometric mechanics, spacecraft dynamics, and polymer physics literature, as well as robotics works that present non-Lie-theoretic formulations in the context of highly parallelizable algorithms.
Article
We provide a tutorial and review of the state-of-the-art in robot dynamics algorithms that rely on methods from differential geometry, particularly the theory of Lie groups. After reviewing the underlying Lie group structure of the rigid-body motions and the geometric formulation of the equations of motion for a single rigid body, we show how classical screw-theoretic concepts can be expressed in a reference frame-invariant way using Lie-theoretic concepts and derive recursive algorithms for the forward and inverse dynamics and their differentiation. These algorithms are extended to robots subject to closed-loop and other constraints, joints driven by variable stiffness actuators, and also to the modeling of contact between rigid bodies. We conclude with a demonstration of how the geometric formulations and algorithms can be effectively used for robot motion optimization.
Article
A complete, stand-alone text for this core aerospace engineering subject * NEW: updated throughout, with new coverage of perturbations, Lambert's problem, attitude dynamics, and techniques for numerically integrating orbits * NEW: more examples and homework problems, more Matlab algorithms * NEW: improved support material, including instructor solutions manual and lecture PowerPoint slides. * NEW: Reorganized and improved discusions of coordinate systems, new discussion on perturbations and quarternions * NEW: Increased coverage of attitude dynamics, including new Matlab algorithms and examples in chapter 10 * New examples and homework problems * Highly illustrated and fully supported with downloadable MATLAB algorithms for project and practical work; fully worked examples throughout; extensive homework exercises; Instructor's Manual and lecture slides.