Fact-checked by Grok 2 weeks ago

Robot kinematics

Robot kinematics is the branch of robotics that analyzes the geometric relationships between a robot's joint parameters—such as angles for revolute joints or displacements for prismatic joints—and the position and orientation of its end-effector or other components in space, without regard to the forces or torques causing the motion.^[1] This field focuses on positions, velocities, and higher-order derivatives of poses for rigid bodies connected by joints, treating motion as a purely geometric phenomenon.^[2] It applies to diverse robotic systems, including serial manipulators, parallel mechanisms, and mobile platforms, enabling tasks like precise positioning and trajectory prediction.^[3] A core component of robot kinematics is forward kinematics, which maps specified joint configurations to the corresponding end-effector pose using transformations, often represented by homogeneous matrices.^[4] For serial chains, this involves composing individual link transformations recursively.^[1] The Denavit-Hartenberg (DH) convention standardizes this process by defining four parameters per joint—link length (a), link twist (α), joint angle (θ), and joint offset (d)—to parameterize the spatial relationships between adjacent links, facilitating efficient computation for multi-degree-of-freedom systems.^[5] This method, introduced in the mid-20th century, remains foundational for modeling manipulators with up to six or more joints.^[6] In contrast, inverse kinematics solves the reverse problem: finding joint variables that achieve a target end-effector pose, which can yield multiple solutions or none, depending on the robot's workspace and redundancy.^[1] Velocity kinematics extends this to rates of change, using Jacobians to relate joint velocities to end-effector linear and angular velocities, essential for real-time control and singularity analysis.^[1] These concepts underpin applications in industrial automation, surgical robotics, and autonomous vehicles, where accurate kinematic models ensure collision-free motion and task execution.^[3]

Basic Concepts

Definition and Scope

Robot kinematics is the study of the motion of robotic systems without considering the forces or torques that produce it, concentrating instead on the positions, velocities, and accelerations of the robot's components relative to one another.^[7] This field examines how joint configurations determine the pose of end-effectors or other key points, using geometric and algebraic models to describe spatial relationships.^[8] The origins of kinematics trace back to classical mechanics in the 18th century, where Leonhard Euler laid foundational work on the three-dimensional motion of rigid bodies, including systematic analyses of rotations and orientations. These principles were later adapted to robotics during the mid-20th century, particularly with the development of early industrial manipulators like the Unimate in the 1960s, which necessitated kinematic models for programming and control.^[9] Kinematics serves as a prerequisite for robot dynamics, which incorporates forces, but remains distinct by focusing solely on geometric constraints and motion descriptions.^[7] In scope, robot kinematics applies broadly to serial manipulators, parallel mechanisms, mobile platforms such as wheeled robots, and humanoid systems, emphasizing mathematical representations of achievable motions.^[7] Central concepts include the configuration space (C-space), an n-dimensional manifold representing all possible joint variable combinations, where n equals the degrees of freedom; the task space, which captures the end-effector's position and orientation in the operational environment; and the workspace, the bounded subset of task space reachable by the end-effector under joint limits.^[7] These elements enable analysis of reachability and constraints essential for robot design and operation.^[8]

Coordinate Frames and Transformations

In robot kinematics, coordinate frames provide a structured way to describe the position and orientation of robot components relative to one another in three-dimensional space. The base frame is typically fixed to the robot's stationary base or the world coordinate system, serving as the reference for all measurements. Intermediate link frames are assigned to each rigid link in the robot's structure, capturing the local position and orientation of that link relative to the previous one. The end-effector frame is attached to the tool or gripper at the robot's tip, representing the final pose where tasks are performed. These frames enable the decomposition of complex robot configurations into manageable parts, facilitating analysis of motion without considering dynamics.^[10] Representing orientations within these frames requires methods to describe rotations, as pure translations are insufficient for rigid bodies. Euler angles parameterize rotations as three sequential angles about the x, y, and z axes, offering an intuitive decomposition but suffering from gimbal lock—a singularity where two axes align, losing a degree of freedom and causing discontinuities in representation. Roll-pitch-yaw (RPY) angles, a common Euler angle convention in robotics and aerospace, typically involve sequential rotations: first yaw about the z-axis, then pitch about the y-axis, and roll about the x-axis. These are often applied using intrinsic rotations about body-fixed axes, aligning with intuitive vehicle motion descriptions, but suffer from gimbal lock near pitch angles of ±90°. Quaternions, four-dimensional vectors (w, x, y, z) with unit norm, avoid singularities and provide smooth interpolation for rotations, making them preferable for computational efficiency and avoiding the 3-to-4 parameter redundancy of matrices, despite requiring normalization to prevent drift. These representations convert to 3x3 rotation matrices for use in transformations, ensuring orthogonal preservation of distances.^[11]^[12] To combine rotation and translation into a single operation, homogeneous transformation matrices are employed, augmenting 3x3 rotation matrices with a 3x1 translation vector in a 4x4 structure:

\begin{bmatrix} \mathbf{R} & \mathbf{p} \\ \mathbf{0}_{1 \times 3} & 1 \end{bmatrix}

where \mathbf{R} is the rotation matrix and \mathbf{p} is the position vector. This form, part of the special Euclidean group SE(3), allows matrix multiplication to compose successive transformations, such as transforming a point from one frame to another by premultiplying its homogeneous coordinates [ \mathbf{x}^T, 1 ]^T. For a robot with n links, the overall transformation from base to end-effector is the chain product T = A_1 A_2 \cdots A_n, where each A_i is the homogeneous matrix for the i-th link transformation. This chaining underpins forward kinematics computations by propagating poses through the robot structure.^[10]^[13]

Kinematic Chains

Serial Manipulators

Serial manipulators, also known as serial-link or open-chain robots, form the backbone of most industrial robotic systems due to their straightforward design and versatility. These robots consist of a fixed base connected to a series of rigid links joined end-to-end by actuators, typically revolute joints that enable rotation or prismatic joints that allow linear translation. This open kinematic chain structure ensures that motion propagates sequentially from the base to the end-effector without forming closed loops, allowing for a tree-like hierarchy where each joint connects a parent link to a child link.^[14]^[3]^[15] The mobility of serial manipulators is determined by the number of independent joint motions, with the degrees of freedom (DOF) equaling the count of joints in non-redundant cases, where each joint contributes one DOF to the overall system. This configuration enables precise control over the end-effector's position and orientation in task space, particularly for manipulators with 6 DOF to achieve full spatial dexterity. Modeling such chains often involves establishing coordinate frames at each joint to track transformations along the structure.^[16] Classic examples of serial manipulators include the PUMA 560, a 6-DOF articulated arm developed for assembly and welding tasks, which exemplifies the anthropomorphic design mimicking human arm motion. Another is the SCARA robot, featuring four DOF with two horizontal revolute joints, a vertical prismatic joint, and a rotational wrist, optimized for high-speed pick-and-place operations in electronics manufacturing. These designs highlight the adaptability of serial structures to diverse applications.^[17] One key advantage of serial manipulators is their extensive reachable workspace, as the sequential extension of links allows access to a broad volume without mechanical interference. However, this open-chain architecture results in lower structural stiffness, leading to greater end-effector deflection under payload or dynamic loads compared to closed-loop alternatives.^[15]^[18]

Parallel and Hybrid Manipulators

Parallel manipulators, also known as closed-chain robots, consist of multiple kinematic chains or legs that connect a fixed base platform to a moving end-effector platform, forming closed loops that impose geometric constraints on the motion. This architecture differs fundamentally from serial manipulators by distributing the end-effector load across several parallel paths, enhancing structural integrity. The seminal example is the Stewart-Gough platform, introduced by V. E. Gough for tire testing in 1947 and later adapted by D. Stewart for flight simulation in 1965, featuring six extensible legs each connected via universal joints to the base and spherical joints to the platform, enabling full six-degree-of-freedom (6-DOF) spatial motion. The mobility, or degrees of freedom (DOF), of parallel manipulators is calculated using the Grübler-Kutzbach criterion, which quantifies the net motion after accounting for joint freedoms and loop constraints: DOF = 6(n - j - 1) + ∑ f_i, where n is the number of links including the fixed frame, j is the number of joints, and f_i is the freedom of the i-th joint; this often yields fewer effective DOF than the number of actuators due to overconstraints, ensuring precise but restricted motion.^[19]^[20] In practice, such systems achieve high precision in constrained tasks, as the closed loops reduce cumulative errors seen in open serial chains. Representative examples include the Delta robot, invented by Reymond Clavel in 1985 at EPFL for high-speed pick-and-place operations in industries like food packaging and electronics assembly, utilizing three parallelogram linkages driven by three rotary motors to achieve 3-DOF translational motion with exceptional acceleration up to 20 g in experimental setups. Hybrid manipulators combine parallel structures with serial or cable-driven elements to mitigate limitations; for instance, hybrid cable-driven systems employ rigid parallel legs augmented by flexible cables, extending the workspace for applications like large-scale handling while preserving stiffness, as demonstrated in designs for overhead manipulation tasks.^[21]^[22] Parallel and hybrid manipulators provide advantages such as superior stiffness-to-weight ratios, enabling payloads up to several times their own mass with positioning accuracies below 0.1 mm, and high dynamic speeds due to low inertia from fixed actuators on the base. However, these benefits come at the cost of a limited and complex workspace shaped by leg interferences and singularities, as well as challenges in forward kinematics due to multiple assembly modes. In comparison to serial manipulators, parallel designs excel in precision-oriented tasks but sacrifice reach.^[23]

Forward Kinematics

Formulation and Denavit-Hartenberg Parameters

The forward kinematics of serial robotic manipulators is formulated by composing homogeneous transformation matrices that map the position and orientation from the base coordinate frame to the end-effector frame through successive link transformations. The Denavit-Hartenberg (DH) convention standardizes this process by assigning a coordinate frame to each link in the kinematic chain, enabling a compact parameterization of the relative pose between frames. Introduced in the seminal work on kinematic notation for mechanisms, this method uses matrix algebra to describe the geometry and configuration of lower-pair joints in serial chains.^[24] Each link i in the chain is characterized by four DH parameters: the link length a_i, which is the distance along the common normal from the z_{i-1} axis to the z_i axis; the link twist \alpha_i, the angle between the z_{i-1} and z_i axes measured in the plane perpendicular to the common normal; the joint angle \theta_i, the rotation about the z_{i-1} axis from the common normal to the x_i axis; and the link offset d_i, the distance along the z_i axis from the common normal to the origin of frame i. These parameters capture both the fixed geometry ( a_i and \alpha_i ) and the variable configuration ( \theta_i for revolute joints or d_i for prismatic joints ). The coordinate frames are assigned systematically: the z_i axis aligns with the axis of joint i+1; the x_i axis lies along the common perpendicular between z_{i-1} and z_i; and the y_i axis completes a right-handed orthogonal frame, with the origin at the intersection of x_i and z_i. For the base frame (frame 0), the z_0 axis aligns with the first joint axis, and the x_0 axis points toward the common normal with z_1. This assignment ensures a unique, minimal description for open serial chains, though the common normal is undefined if axes are parallel or intersecting.^[25]^[24] The transformation from frame i-1 to frame i, denoted ^{i-1}\mathbf{A}_i, is a 4×4 homogeneous matrix derived as the product of basic rotations and translations corresponding to the DH parameters:

\begin{bmatrix} \cos \theta_i & -\sin \theta_i \cos \alpha_i & \sin \theta_i \sin \alpha_i & a_i \cos \theta_i \\ \sin \theta_i & \cos \theta_i \cos \alpha_i & -\cos \theta_i \sin \alpha_i & a_i \sin \theta_i \\ 0 & \sin \alpha_i & \cos \alpha_i & d_i \\ 0 & 0 & 0 & 1 \end{bmatrix}

The overall forward kinematics is obtained by multiplying these matrices: \mathbf{T} = ^{0}\mathbf{A}_1 ^{1}\mathbf{A}_2 \cdots ^{n-1}\mathbf{A}_n, yielding the end-effector pose.^[25]^[24] Despite its widespread adoption, the DH convention has limitations, particularly in cases where consecutive joint axes are parallel (\alpha_i = 0 or \pi, making a_i indeterminate) or intersecting ( a_i = 0, with the direction of the common normal arbitrary), as in spherical wrists where multiple revolute axes meet at a point. These configurations lead to non-unique parameter assignments and potential numerical instabilities in kinematic computations. To mitigate such issues, alternatives like the modified DH convention have been proposed, which relocates the frame attachment to the proximal end of the link for improved consistency in parameter tables.^[25]^[26]

Computation for Serial Chains

The computation of forward kinematics for serial robot chains determines the pose (position and orientation) of the end-effector relative to the base frame given the joint variables, using homogeneous transformation matrices based on Denavit-Hartenberg (DH) parameters. The DH parameters serve as inputs to define the geometry and joint displacements for each link in the open kinematic chain.^[27] The end-effector transformation is obtained by the product of individual link transformations:

^{0}T_{n} = A_1 A_2 \cdots A_n

where n is the number of links, and each A_i is the 4×4 homogeneous matrix:

A_i = \begin{bmatrix} \cos \theta_i & -\sin \theta_i \cos \alpha_i & \sin \theta_i \sin \alpha_i & a_i \cos \theta_i \\ \sin \theta_i & \cos \theta_i \cos \alpha_i & -\cos \theta_i \sin \alpha_i & a_i \sin \theta_i \\ 0 & \sin \alpha_i & \cos \alpha_i & d_i \\ 0 & 0 & 0 & 1 \end{bmatrix}

Here, \theta_i and d_i are the joint variables (angle for revolute joints, offset for prismatic joints), while a_i and \alpha_i are fixed link parameters.^[27] The step-by-step process begins with assigning DH parameters to the serial chain based on the robot's link lengths, twists, offsets, and joint types. For a given set of joint variables, compute each A_i by substituting the parameters and variables into the matrix form. Then, multiply the matrices sequentially: start with A_1, post-multiply by A_2, and continue up to A_n. The resulting ^{0}T_n matrix encodes the end-effector position in its fourth column (translation vector) and orientation in the upper-left 3×3 submatrix (rotation matrix relative to the base). This matrix multiplication is computationally efficient for serial chains, as each step builds upon the previous transformation without cycles.^[27] Consider a 2-DOF planar revolute arm with equal link lengths l_1 = l_2 = l, operating in the xy-plane. The DH parameters are a_1 = l, \alpha_1 = 0, d_1 = 0, \theta_1 variable; a_2 = l, \alpha_2 = 0, d_2 = 0, \theta_2 variable. Computing ^{0}T_2 = A_1 A_2 yields the end-effector position:

x = l (\cos \theta_1 + \cos(\theta_1 + \theta_2)), \quad y = l (\sin \theta_1 + \sin(\theta_1 + \theta_2))

and orientation angle \phi = \theta_1 + \theta_2, demonstrating how trigonometric simplification arises from the matrix product for planar cases.^[27] For a 3-DOF cylindrical robot, featuring a base revolute joint (\theta_1), followed by radial prismatic (d_2) and vertical prismatic (d_3) joints, the DH parameters include a_1 = 0, \alpha_1 = 90^\circ, d_1 = 0; a_2 = d_2 (variable), \alpha_2 = -90^\circ, d_2 = 0; a_3 = 0, \alpha_3 = 0, d_3 variable. The forward kinematics ^{0}T_3 = A_1 A_2 A_3 results in end-effector position:

x = d_2 \cos \theta_1, \quad y = d_2 \sin \theta_1, \quad z = d_3

with the rotation matrix reflecting the base rotation about the z-axis, illustrating adaptation for prismatic joints in cylindrical coordinates.^[27]^[28]

Inverse Kinematics

Closed-Form Solutions

Closed-form solutions for inverse kinematics provide exact analytical expressions for the joint variables required to achieve a specified end-effector pose, derived by inverting the forward kinematic equations or exploiting geometric properties of the manipulator. These methods are particularly effective for serial manipulators with low degrees of freedom (DOF) or specific architectures that simplify the nonlinear equations into solvable algebraic forms. Unlike numerical approaches, closed-form solutions offer computational efficiency and guarantee all possible configurations when they exist, though their derivation often requires assumptions about joint types and link arrangements. Algebraic solutions manipulate the forward kinematic equations directly, typically using trigonometric identities to resolve the joint angles. For a 3-DOF planar manipulator with revolute joints and link lengths l_1, l_2, and l_3, to achieve end-effector position (x, y) and orientation \phi, first compute the position at the end of the second link: x_c = x - l_3 \cos \phi, y_c = y - l_3 \sin \phi. The equations then yield a quadratic in terms of \cos \theta_2, solved via the law of cosines:

\cos \theta_2 = \frac{x_c^2 + y_c^2 - l_1^2 - l_2^2}{2 l_1 l_2},

where (x_c, y_c) is the offset position. Then, \theta_2 = \pm \arccos(\cdot), and \theta_1 follows from

\theta_1 = \atantwo(y_c, x_c) - \atantwo(l_2 \sin \theta_2, l_1 + l_2 \cos \theta_2),

with \theta_3 = \phi - \theta_1 - \theta_2.^[29] This approach extends to other low-DOF cases but grows complex with higher dimensions due to entangled trigonometric terms. Geometric methods decompose the manipulator into subproblems based on structural symmetries, such as spherical wrists where the final three joint axes intersect at a point. Pieper's method, applicable to 6-DOF serial arms with this configuration (common in industrial robots like the PUMA 560), decouples the problem: first, solve for the first three joints to position the wrist center using a 3-DOF spherical trigonometry reduction, then independently compute the last three wrist angles from the end-effector orientation relative to that center. This yields up to eight solutions by enumerating sign choices in the spherical triangle. Solutions may not always exist or be unique, depending on workspace boundaries and pose feasibility; for instance, the 3-DOF planar arm admits two configurations (elbow up and elbow down) within the reachable workspace, but none outside the maximum reach l_1 + l_2 + l_3 or when the discriminant of the quadratic is negative. Workspace constraints, such as joint limits and self-collisions, further restrict valid solutions, requiring post-validation. Closed-form methods are generally limited to manipulators with up to 6 DOF and special geometries, like offset-free joints or parallel axes, as higher-DOF systems lead to high-degree polynomials without analytical roots. Beyond these cases, the equations become intractable, necessitating numerical alternatives for general architectures.

Numerical and Iterative Methods

Numerical and iterative methods provide approximate solutions to the inverse kinematics problem for robotic manipulators where closed-form expressions are infeasible, such as in high-degree-of-freedom systems or complex geometries. These approaches typically frame the problem as minimizing the error e(q) = x_{\text{des}} - f(q), where x_{\text{des}} is the desired end-effector pose, f(q) is the forward kinematics function, and q are the joint variables. Iterations update q until \|e(q)\| falls below a tolerance, often leveraging the manipulator Jacobian J(q) = \frac{\partial f}{\partial q} for local linearization. The Jacobian pseudoinverse and Newton-Raphson techniques represent foundational iterative strategies, while optimization-based formulations extend these to handle redundancy by incorporating secondary objectives. The Jacobian pseudoinverse method computes joint increments as the minimum-norm solution to the underdetermined system J \Delta q = \Delta x, where \Delta x approximates the pose error. The update rule is \Delta q = J^+ \Delta x, with J^+ = V \Sigma^+ U^T obtained via singular value decomposition (SVD) of J = U \Sigma V^T, and \Sigma^+ inverting non-zero singular values. Starting from an initial guess q_0, the algorithm iterates q_{k+1} = q_k + \alpha \Delta q_k (with step size \alpha \leq 1) until convergence, providing the smallest \|\Delta q\| that best reduces the task-space error in a least-squares sense. This approach originated in resolved motion rate control for velocity-level kinematics and has been widely adopted for its computational efficiency in non-redundant and mildly redundant manipulators.^[30] The Newton-Raphson method solves the nonlinear root-finding problem e(q) = 0 through successive linear approximations, suitable for both position and orientation errors in end-effector poses. At each iteration, the error Jacobian \frac{\partial e}{\partial q} \approx -J yields the update \Delta q = -(J^T J)^{-1} J^T e under the Gauss-Newton approximation, which replaces the full Hessian H = J^T J - \sum ( \frac{\partial J_i}{\partial q} )^T e_i with J^T J to avoid costly second-derivative computations. For full second-order accuracy, the exact Newton step \Delta q = -H^{-1} \nabla e can be used, but the approximation suffices for most robotic applications due to rapid quadratic convergence near the solution. Initialization with a feasible q_0 (e.g., from a prior pose) ensures local convergence, typically in 5-10 iterations for 6-DOF arms.^[31] In redundant manipulators, where the number of joints exceeds task dimensions, optimization-based methods resolve the infinite solutions by minimizing a cost function while satisfying the primary kinematic constraint f(q) = x_{\text{des}}. A common formulation minimizes the joint norm \min_q \|q\|^2 subject to the constraint, solved via the augmented solution \dot{q} = J^+ \dot{x} + (I - J^+ J) z, where z projects secondary tasks (e.g., singularity avoidance) into the nullspace of J. Quadratic programming extends this to include bounds on joint rates or accelerations, enabling criteria like minimum energy or obstacle avoidance. This framework, building on pseudoinverse extensions, allows prioritization of tasks in hierarchical control.^[32] Convergence challenges in these methods often stem from kinematic singularities, where J loses rank, causing J^+ to amplify noise and produce unbounded \Delta q. Damped least-squares addresses this by regularizing the pseudoinverse as J^+_\lambda = (J^T J + \lambda^2 I)^{-1} J^T, with damping parameter \lambda > 0 selected dynamically (e.g., \lambda \propto 1/|\sigma_{\min}| near small singular values \sigma_{\min}) to bound \|\Delta q\| \leq \delta, at the cost of residual pose error \|J \Delta q - \Delta x\| \leq \epsilon. For 7-DOF arms, such as those in humanoid or orbital manipulators, damping prevents erratic motion during shoulder-elbow singularities.

Jacobian Analysis

Jacobian Matrix Derivation

The Jacobian matrix in robot kinematics provides a linear mapping from the joint velocity vector \dot{\mathbf{q}} to the end-effector velocity vector, expressed as \mathbf{v} = \mathbf{J}(\mathbf{q}) \dot{\mathbf{q}}, where \mathbf{v} combines linear and angular components of the end-effector motion. This derivation arises from differentiating the forward kinematics, which describe the end-effector pose as a function of joint variables \mathbf{q}, yielding the instantaneous velocity relationship at a given configuration.^[26]^[33] The geometric Jacobian \mathbf{J}_g is derived by considering the partial derivatives of the end-effector pose with respect to each joint variable, focusing on the geometric contributions of joint motions to spatial velocities. For a serial manipulator, the i-th column of \mathbf{J}_g is given by \partial \mathbf{x} / \partial q_i, where \mathbf{x} represents the end-effector position and orientation; this combines linear velocity \mathbf{v} from the translational effect of joint i and angular velocity \boldsymbol{\omega} from its rotational effect. Specifically, for revolute joints, the linear part involves the cross product of the joint axis unit vector \mathbf{z}_{i-1} and the vector from the joint i origin to the end-effector origin, \mathbf{o}_n - \mathbf{o}_{i-1}, while the angular part is simply \mathbf{z}_{i-1}. For prismatic joints, the linear contribution is along \mathbf{z}_{i-1} and the angular is zero. This form emphasizes the physical interpretation of how each joint infinitesimally affects the end-effector twist.^[26] In the analytical Jacobian \mathbf{J}_a, derived using Denavit-Hartenberg (DH) parameters, the velocity components are computed recursively through the kinematic chain. The linear velocity Jacobian \mathbf{J}_v has columns \mathbf{J}_{v_i} = \mathbf{z}_{i-1} \times (\mathbf{o}_n - \mathbf{o}_{i-1}) for revolute joints (and \mathbf{z}_{i-1} for prismatic), expressed in the base frame via transformation matrices from the DH convention. The angular velocity Jacobian \mathbf{J}_\omega has columns \mathbf{z}_{i-1} for revolute joints (zero for prismatic). These are obtained by propagating velocities from the base to the end-effector using rotation matrices and position vectors defined by DH parameters a_i, \alpha_i, d_i, \theta_i.^[26] The full Jacobian for spatial motion in 3D is a 6×n matrix stacking the linear and angular parts:

\mathbf{J} = \begin{bmatrix} \mathbf{J}_v \\ \mathbf{J}_\omega \end{bmatrix},

where \mathbf{v} = \mathbf{J}_v \dot{\mathbf{q}} and \boldsymbol{\omega} = \mathbf{J}_\omega \dot{\mathbf{q}} describe the end-effector twist. For non-redundant manipulators with 6 degrees of freedom (n=6), \mathbf{J} is square; for redundant systems (n>6), it is rectangular, enabling mappings from higher-dimensional joint spaces to task space. The geometric and analytical forms coincide for linear and angular velocities but differ when orientation is parameterized (e.g., via Euler angles in \mathbf{J}_a).^[26]^[33]

Singularity Analysis

In robot kinematics, singularities represent critical configurations where the Jacobian matrix, which maps joint velocities to end-effector velocities, loses full rank, thereby reducing the instantaneous degrees of freedom of the manipulator. This rank deficiency alters the manipulator's mobility, making certain end-effector motions impossible or requiring unbounded joint rates. The analysis of these points is essential for ensuring stable control and predictable behavior in robotic systems.^[34] For typical serial manipulators, such as 6-degree-of-freedom (DOF) anthropomorphic arms, singularities are categorized into three primary types based on their geometric and structural characteristics. Wrist singularities arise in wrist-partitioned designs when the final three joint axes align or intersect at a common point, causing a loss of independent control over end-effector orientation. Shoulder singularities occur when the projection of the wrist center onto the plane perpendicular to the base rotation axis aligns with the shoulder joint, typically reducing positional freedom in the arm's extension. Boundary singularities manifest at the periphery of the workspace, often due to joint limits or full extension of the links, where the manipulator's reach constraints lead to rank loss. These classifications stem from the geometric constraints inherent in standard manipulator architectures.^[34] Detection of singularities relies on evaluating the Jacobian matrix's properties at a given joint configuration \mathbf{q}. A configuration is singular if the rank of the Jacobian \mathbf{J}(\mathbf{q}) drops below the minimum of the task space dimension and the manipulator's DOF. For practical computation, especially with non-square Jacobians, the singular value decomposition (SVD) is employed, identifying singularity when the smallest singular value \sigma_{\min} = 0. Equivalently, for square Jacobians or to avoid direct SVD, the condition \det(\mathbf{J}(\mathbf{q}) \mathbf{J}(\mathbf{q})^T) = 0 indicates rank deficiency, as this determinant measures the squared volume of the parallelepiped spanned by the Jacobian columns. These methods provide a numerical means to locate singular loci within the configuration space.^[34] The implications of encountering singularities are profound for robot operation and control. In singular configurations, finite velocities or forces at the end-effector may demand infinite joint velocities, as the pseudo-inverse of the Jacobian becomes ill-conditioned or undefined, leading to erratic motion or complete loss of controllability in specific directions. This can result in diminished stiffness, increased sensitivity to disturbances, and potential mechanical stress on actuators, compromising task execution and safety. Such effects highlight the need for singularity-aware planning to maintain operational reliability.^[34] To mitigate singularities, avoidance techniques focus on trajectory optimization and robust inverse kinematics formulations. Path planning methods delineate singularity-free regions in joint or workspace coordinates, restricting motions to avoid critical manifolds through constrained optimization or workspace decomposition. Additionally, the damped least-squares method modifies the standard pseudo-inverse by adding a damping term \lambda^2 \mathbf{I} to the task-space normal equations, yielding \dot{\mathbf{q}} = \mathbf{J}^T (\mathbf{J} \mathbf{J}^T + \lambda^2 \mathbf{I})^{-1} \mathbf{v}, where \lambda is adaptively increased near singularities to bound joint velocities while accepting minor end-effector tracking errors. This approach ensures continuous, feasible solutions without abrupt discontinuities.^[34]

Velocity and Force Kinematics

Velocity Kinematics

Velocity kinematics describes the relationship between the velocities of a robot's joints and the velocity of its end-effector, providing a differential mapping that extends position kinematics to instantaneous motion analysis.^[7] This is essential for trajectory planning, control, and understanding dynamic behavior in robotic systems, particularly for manipulators where joint rates must produce desired end-effector twists (linear and angular velocities).^[7] The core equation of velocity kinematics is \dot{x} = J(q) \dot{q}, where \dot{x} represents the end-effector twist—a six-dimensional vector combining linear velocity v and angular velocity \omega—q is the joint configuration vector, \dot{q} is the joint velocity vector, and J(q) is the Jacobian matrix, which depends on the current configuration q.^[7] The Jacobian can be formulated in space coordinates (J_s) or body coordinates (J_b), with the space Jacobian relating joint velocities to the twist in the fixed frame and the body Jacobian to the twist in the end-effector frame; they are related by the adjoint transformation J_s(\theta) = \mathrm{Ad}_{T_{sb}} J_b(\theta).^[7] This formulation, originally introduced in resolved motion rate control for coordinating manipulator motions, allows computation of end-effector velocities from joint rates without solving the full inverse kinematics problem.^[30] To extend to accelerations, differentiate the velocity equation with respect to time, yielding the acceleration kinematics equation:

\ddot{x} = \dot{J}(q) \dot{q} + J(q) \ddot{q},

where \dot{J}(q) is the time derivative of the Jacobian, incorporating Coriolis and centripetal terms that arise from the configuration-dependent nature of J.^[7] These terms account for the nonlinear coupling in the kinematic chain, enabling prediction of end-effector accelerations from joint accelerations and velocities, which is critical for dynamic simulation and feedforward control.^[7] For kinematically redundant manipulators, where the number of joints exceeds the task-space dimensions (n > m), the underdetermined system \dot{x} = J(q) \dot{q} admits infinitely many solutions. The minimum-norm solution is given by the Moore-Penrose pseudoinverse: \dot{q} = J^+(q) \dot{x}, where J^+(q) = J^T(q) (J(q) J^T(q))^{-1}.^[7] To optimize secondary objectives, such as avoiding joint limits or minimizing energy, project an arbitrary null-space velocity \dot{q}_0 onto the kernel of J:

\dot{q} = J^+(q) \dot{x} + (I - J^+(q) J(q)) \dot{q}_0.

This null-space term enables exploitation of redundancy for tasks like obstacle avoidance while satisfying the primary velocity constraint, a foundational approach for supervisory control in multibody systems.^[7] A representative example is the instantaneous motion of a 3-DOF planar revolute arm with equal link lengths L = 1 m, operating in the xy-plane with joint angles \theta_1, \theta_2, \theta_3. The end-effector position is x = L (\cos \theta_1 + \cos(\theta_1 + \theta_2) + \cos(\theta_1 + \theta_2 + \theta_3)), y = L (\sin \theta_1 + \sin(\theta_1 + \theta_2) + \sin(\theta_1 + \theta_2 + \theta_3)). The Jacobian for linear velocity (ignoring out-of-plane motion) is

J(q) = \begin{bmatrix} -L \sin \theta_1 - L \sin(\theta_1 + \theta_2) - L \sin(\theta_1 + \theta_2 + \theta_3) & -L \sin(\theta_1 + \theta_2) - L \sin(\theta_1 + \theta_2 + \theta_3) & -L \sin(\theta_1 + \theta_2 + \theta_3) \\ L \cos \theta_1 + L \cos(\theta_1 + \theta_2) + L \cos(\theta_1 + \theta_2 + \theta_3) & L \cos(\theta_1 + \theta_2) + L \cos(\theta_1 + \theta_2 + \theta_3) & L \cos(\theta_1 + \theta_2 + \theta_3) \end{bmatrix},

such that \begin{bmatrix} \dot{x} \\ \dot{y} \end{bmatrix} = J(q) \begin{bmatrix} \dot{\theta_1} \\ \dot{\theta_2} \\ \dot{\theta_3} \end{bmatrix}. For a configuration \theta = [0, 0, 0]^T rad and joint rates \dot{\theta} = [1, 0, 0]^T rad/s, the end-effector linear velocity is \dot{x} = 0 m/s, \dot{y} = 3 m/s, illustrating pure translation along y due to the first joint's rotation.^[7]

Static Force Transmission

In static force transmission, the relationship between end-effector wrenches and joint torques is established through the transpose of the Jacobian matrix, enabling the analysis of force propagation in robots under static equilibrium conditions.^[7] The end-effector wrench \mathbf{F}, which combines linear forces and torques in six dimensions, is mapped to the joint torque vector \boldsymbol{\tau} via the equation \boldsymbol{\tau} = \mathbf{J}^T \mathbf{F}, where \mathbf{J} is the manipulator Jacobian.^[7]^[26] This mapping assumes no inertial effects, focusing solely on kinematic structure to determine the joint efforts required to balance external loads at the end-effector.^[7] The validity of this static equation derives from the principle of virtual power conservation, which equates the power in joint space to that in task space: \dot{\mathbf{q}}^T \boldsymbol{\tau} = \dot{\mathbf{x}}^T \mathbf{F}.^[7]^[26] Substituting the velocity kinematics \dot{\mathbf{x}} = \mathbf{J} \dot{\mathbf{q}} into the power equation yields \dot{\mathbf{q}}^T \mathbf{J}^T \mathbf{F} = \dot{\mathbf{q}}^T \boldsymbol{\tau}, confirming \boldsymbol{\tau} = \mathbf{J}^T \mathbf{F} for arbitrary virtual joint velocities \dot{\mathbf{q}}.^[7] This duality highlights static force transmission as the adjoint of velocity kinematics, where forces transform contravariantly opposite to velocities.^[7] To visualize the robot's ability to transmit forces, the force ellipsoid is constructed from the positive semi-definite matrix \mathbf{J} \mathbf{J}^T, defined by the quadratic form \mathbf{F}^T \mathbf{J} \mathbf{J}^T \mathbf{F} = 1.^[7] The principal axes of this ellipsoid align with the eigenvectors of \mathbf{J} \mathbf{J}^T, and the semi-axis lengths are the reciprocals of the square roots of its eigenvalues, indicating the magnitude of force exertion possible in different directions with unit joint torque norm.^[7] Longer semi-axes (corresponding to smaller eigenvalues) indicate directions of higher force manipulability, providing a geometric measure of the robot's static force capabilities across configurations.^[7] These concepts find application in stiffness analysis for tasks requiring precise force control, such as robotic assembly, where the Jacobian-based mapping helps evaluate end-effector compliance under external loads to ensure accurate part insertion and minimize positioning errors.^[7]^[35] In assembly operations, the force ellipsoid aids in identifying configurations that optimize stiffness isotropy, reducing deformation from contact forces during mating processes.^[35]

Advanced Topics

Redundant Manipulators

Redundant manipulators are robotic systems with more degrees of freedom (DOF) than required for a specific task, denoted as n > m, where m = 6 for tasks involving full six-dimensional spatial positioning and orientation. This excess DOF, known as kinematic redundancy, provides flexibility beyond minimal task execution, allowing the system to achieve additional objectives without altering the primary end-effector pose. The inverse kinematics problem for such manipulators yields an infinite set of solutions, which can be parameterized as \mathbf{q} = \mathbf{q}_p + \mathbf{q}_n, where \mathbf{q}_p is a particular solution that satisfies the task constraints (e.g., obtained via the Moore-Penrose pseudoinverse of the Jacobian), and \mathbf{q}_n lies in the null space of the Jacobian, representing self-motions that do not affect the end-effector. This decomposition enables the exploitation of redundancy at the kinematic level. Numerical iterative methods, such as those based on Jacobian pseudoinverses, can be extended to incorporate this parameterization for real-time computation.^[36] The null space component \mathbf{q}_n is particularly valuable for optimization, as it allows projection of secondary tasks or cost functions without compromising the primary motion. Common objectives include minimizing joint velocities to reduce energy consumption, enforcing joint limit avoidance to prevent mechanical constraints, or implementing obstacle avoidance by steering clear of forbidden regions in configuration space. These optimizations are achieved by selecting \mathbf{q}_n = (I - J^\dagger J) \mathbf{z}, where J^\dagger is the pseudoinverse and \mathbf{z} is chosen to minimize a secondary criterion, often via quadratic programming or gradient projection. Examples of redundant manipulators include humanoid robot arms, which typically feature 7 or more DOF to replicate human-like dexterity and provide redundancy for tasks like manipulation in cluttered environments. Snake-like or hyper-redundant robots, with dozens of actuated segments, further illustrate this concept by enabling serpentine locomotion and precise tip positioning in confined or irregular spaces.^[37]^[38]

Mobile Robot Kinematics

Mobile robot kinematics addresses the motion of ground-based platforms, such as wheeled and legged systems, which operate under constraints imposed by terrain interaction and locomotion mechanisms. Unlike fixed-base manipulators, mobile robots exhibit degrees of freedom influenced by non-holonomic constraints that limit instantaneous velocity directions, requiring specialized forward and inverse kinematic models to map actuator commands to platform trajectories. These models are essential for path planning, localization, and control in unstructured environments.^[39] Wheeled mobile robots commonly employ differential drive configurations, where two independently actuated wheels mounted on a common axle control both linear and angular velocities. The forward kinematics for a differential drive robot relate wheel velocities v_r and v_l (right and left, respectively) to the platform's linear velocity v and angular velocity \omega as follows:

\begin{align*} v &= \frac{v_r + v_l}{2}, \\ \omega &= \frac{v_r - v_l}{b}, \end{align*}

where b is the baseline distance between the wheels; this model assumes no slipping and enables precise odometry computation from encoder feedback.^[40] Another prevalent wheeled model is Ackermann steering, used in car-like robots, which coordinates front-wheel steering angles to achieve smooth turning radii while minimizing tire scrub. In this setup, the rear wheels remain fixed, and the steering angles \delta_i for front wheels are computed to ensure all wheels roll around a common instantaneous center of rotation, typically via geometric relations derived from the vehicle's wheelbase and track width.^[41] Non-holonomic constraints arise in these wheeled systems due to the no-sideways-slip condition, restricting motion to the wheel plane and preventing arbitrary planar velocities. For a differential drive robot with position (x, y) and orientation \theta, the primary non-holonomic constraint is expressed as:

\dot{x} \sin \theta - \dot{y} \cos \theta = 0,

which enforces that the velocity vector aligns with the robot's heading, making the system underactuated and necessitating path-following strategies like dubins paths for navigation.^[42] Legged robots introduce more complex kinematics due to intermittent ground contacts and multi-joint legs, often modeled as serial chains with inverse kinematics solving for joint angles given desired foot positions. For a single leg, inverse kinematics determines hip, knee, and ankle angles to place the foot at a target location relative to the body, typically using geometric methods like the law of cosines for planar legs or Jacobian-based iteration for spatial configurations, ensuring stability during stance phases.^[43] In full locomotion, gait cycles coordinate multiple legs, with the zero-moment point (ZMP) serving as a key criterion for dynamic balance; the ZMP is the projection of the net ground reaction forces onto the support polygon, maintained within it to prevent tipping, as originally formulated for bipedal stability and extended to quadrupeds.^[44] Practical examples illustrate these models: the Pioneer 3-DX platform from MobileRobots employs differential drive for indoor navigation research, leveraging the kinematics for reliable odometry in mapping tasks. Similarly, Boston Dynamics' Spot quadruped uses advanced legged kinematics to achieve versatile terrain traversal, integrating foot placement inverse solutions with ZMP-based gait generation for robust outdoor mobility.^[45] For hybrid mobile-manipulator systems, Jacobian analysis briefly extends these models to couple base motion with arm velocities.^[39]

References

[1]
[PDF] Kinematics
Kinematics is a geometric approach to robot motion. It is the study of positions and angles and their rates of change. In kinematics, we study abstractions ...
[2]
[PDF] Handbook of Robotics Chapter 1: Kinematics
Sep 17, 2007 · It is important to note that this definition in- cludes an assumption that the pose of the mechanism is completely known. In most situations ...
[3]
Chapter 5. Robot kinematics
Kinematics is the study of the relationship between a robot's joint coordinates and its spatial layout, and is a fundamental and classical topic in robotics.Forward kinematics · 2D forward kinematics for a... · 3D forward kinematics
[4]
[PDF] An Introduction to Robot Kinematics
Page 2. Carnegie Mellon. Robot kinematics refers to the geometry. and movement of robotic mechanisms. Prof Michael Kaess 16-665: Robot Mobility In Air, Land, ...
[5]
[PDF] Forward Kinematics
The Denavit-Hartenberg convention defines four parameters and some rules to help characterize arbitrary kinematic chains the axis is perpendicular to, and ...
[6]
[PDF] Denavit Hartenberg Parameters - Robotics
Denavit-Hartenberg parameters which describe it. For a six-jointed robot. 18 numbers would be required to completely describe the fixed portion of its ...
[7]
[PDF] MODERN ROBOTICS - Mech
May 3, 2017 · Second, Modern Robotics goes beyond a focus on robot mechanisms to ad- dress the interaction with objects in the surrounding world. When robots ...
[8]
[PDF] Introduction To Robotics Saeed B Niku
Introduction to Robotics: Definitions, history, and classifications of robots. 1. Robot Kinematics: Study of robot motion without regard to forces, including.
[9]
Robotics -- Past, Present, and Future | NIST
Oct 4, 1985 · This paper will present a brief history of robotics and examine the following current research topics: (1) Kinematics, Dynamics, and Mobility
[10]
3.3.1. Homogeneous Transformation Matrices – Modern Robotics
This is called the homogeneous coordinate representation of the 3-vector. Finally, a transformation matrix can be used to displace a point or a frame.
[11]
https://manipulation.csail.mit.edu/pick.html
[12]
[PDF] 1 Quaternions and Rotations - University of Southern California
• Euler angles. – roll, pitch, yaw. – no redundancy (good). – gimbal lock singularities. • Quaternions. – generally considered the “best” representation. – ...
[13]
CoordinateTransformations - Intelligent Motion Lab
Homogeneous coordinates represent rigid transforms using matrix multiplication in an n+1 dimensional space where the last coordinate is either 0 or 1.
[14]
[PDF] Kinematics of Serial Manipulators - Mechanical | IISc
A serial manipulator has a fixed base, links connected by joints, and a free end. Its kinematics involves studying motion of links without external forces.
[15]
[PDF] Robot Analysis The Mechanics Of Serial And Parallel Manipulators
Structural Overview Serial manipulators consist of a chain of links connected end-to-end by joints, typically revolute (rotational) or prismatic (linear), ...
[16]
[PDF] Robot Manipulators - Maplesoft
By Kinematic Structure. Open-loop manipulator (or serial robot): A manipulator is called an open-loop manipulator if its links form an open-loop chain.
[17]
[PDF] WORKSPACE COMPUTATION USING MOTION ANALYSIS - ijmerr
chain is a parallel manipulator. The classification of the robots is shown in Figure. 1. SCARA, SCORBOT, PUMA are best examples of Serial Manipulators. They ...
[18]
[PDF] Kinematics and Workspace Analysis of a Three-Axis Parallel ... - arXiv
flexibility and manoeuvrability), serial manipulators have disadvantages of low precision, low stiffness and low power. Also, they are generally operated at ...
[19]
Chebychev–Grübler–Kutzbach's criterion for mobility calculation of ...
The paper presents a critical review of the well known Chebychev–Grübler–Kutzbach's criterion for global mobility calculation of multi-loop mechanisms.
[20]
Delta Parallel Robot — the Story of Success - ResearchGate
The Delta Robot [2] is a type of parallel robot invented by Reymond Clavel in the early 1980s. The Delta Robot comprises three arms connected to rotary joints ...
[21]
Research paper Design and control optimization for hybrid ...
Cable-Driven Parallel Robots (CDPRs) are a type of manipulator where the EE is moved by multiple cables arranged in parallel. Typically, cables are spooled on ...
[22]
[PDF] Parallel manipulators: state of the art and perspectives 1 Introduction
The parallel manipulators developed at MEL in Japan should be mentioned: one of them being a micro manipulator which linear actuators range are a few.
[23]
A Kinematic Notation for Lower-Pair Mechanisms Based on Matrices
Jun 4, 2021 · A symbolic notation which permits the complete description of the kinematic properties of all lower-pair mechanisms by means of equations.
[24]
[PDF] A Mathematical Introduction to Robotic Manipulation
The selection of topics—from kinematics and dynamics of single robots, to grasping and manipulation of objects by multifingered robot hands, to nonholonomic ...
[25]
[PDF] Introduction to Robotics - GitHub Pages
Page 1. Introduction to Robotics. Mechanics and Control. Third Edition. John J. Craig ... transformations. 19. 3 Manipulator kinematics. 62. 4 Inverse manipulator ...
[26]
[PDF] FORWARD KINEMATICS: THE DENAVIT-HARTENBERG ...
The Denavit-Hartenberg parameters are shown in Table 3.3. The Stanford manipulator is an example of a manipula- tor that possesses a wrist of this type. In ...
[27]
[PDF] Kinematic Analysis of Two Degree of Freedom Closed Chain ...
the forward kinematics is not so straight forwards as in serial manipulators, since their kinematics is constrained by loop closure equations. Therefore ...
[28]
Resolved Motion Rate Control of Manipulators and Human Prostheses
The approach suggests solutions to problems of coordination, motion under task constraints, and appreciation of forces encountered by the controlled hand.Missing: PDF | Show results with:PDF
[29]
https://motion.cs.illinois.edu/RoboticSystems/InverseKinematics.html
[30]
https://ieeexplore.ieee.org/document/4081862
[31]
[PDF] MODERN ROBOTICS - Mech
Dec 30, 2019 · More information on the book, including software, videos, online courses, simulations, practice problems, errata, and an errata reporting form ...
[32]
Kinematic Singularities of Robot Manipulators - IntechOpen
Kinematic Singularities of Robot Manipulators. Written By. Peter Donelan. Published: 01 April 2010. DOI: 10.5772/9548. REGISTER TO DOWNLOAD FOR FREE. Share.
[33]
None
### Summary of Assembly Tasks, Robotic Assembly, and Stiffness Analysis Applications
[34]
Inverse Kinematic Solutions With Singularity Robustness for Robot ...
An inverse kinematic solution with singularity robustness determines joint motion for robot endeffector motion, even near singular points, using the SR-inverse.
[35]
Redundancy parameterization and inverse kinematics of 7-DOF ...
Seven-degree-of-freedom (DOF) robot arms have one redundant DOF for obstacle and singularity avoidance which must be parameterized to fully specify the ...
[36]
Kinetostatics of a Snake Robot with Redundant Degrees of Freedom
Aug 1, 2024 · ... Redundant Snake-like Manipulator for Inspection and Maintenance. Appl. Sci. 2022, 12, 3348. [Google Scholar] [CrossRef]; Staritz, P.J.; Skaff ...
[37]
[PDF] 3 Mobile Robot Kinematics - Carnegie Mellon University
Kinematics is the most basic study of how mechanical systems behave. In mobile robotics, we need to understand the mechanical behavior of the robot both in ...
[38]
[PDF] 1 Differential Drive Kinematics - Columbia CS
Many mobile robots use a drive mechanism known as differential drive. It consists of 2 drive wheels mounted on a common axis, and each wheel can ...Missing: seminal paper
[39]
[PDF] Mobile Robot Kinematics
• Robot mobility is a function constraint #, not wheel #. • Ackermann steering = 4 wheels, 3 constraints. • Single track (bicycle) = 2 wheels, 2 constraints.
[40]
[PDF] Nonholonomic Constraints in Robotics
Constraint: ˙y. ˙x = senθ cos θ ⇒. ˙xsenθ − ˙y cosθ = 0. Angular momentum conservation. E.g.: jumping robot. q3 q2 q1. Assuming zero initial angular momentum,.
[41]
[PDF] Hybrid Operational Space Control for Compliant Legged Systems
the swing foot (red dotted line) is considered as an inverse kinematics problem. There are no direct means of regulating the acceleration of these position ...
[42]
[PDF] Zero-moment Point: Thirty five years of its life.
This paper is devoted to the permanence of the concept of Zero-Moment Point, widely- known by the acronym ZMP. Thirty-five years have elapsed since its ...
[43]
About the Spot Robot - Boston Dynamics Support Center
Spot is a quadruped (four-legged) robot capable of mobility on a variety of terrains. Spot uses multiple sensors and three motors in each leg to navigate ...