Kinetostatic Analysis for 6RUS Parallel Continuum Robot using Cosserat Rod Theory

Introduction

The paper discusses Parallel Kinematic Mechanisms (PKMs), which offer advantages over serial manipulators, such as higher stiffness, agility, and payload capacity. PKMs find applications in various fields, including manufacturing, rehabilitation, medical surgery, vehicle simulators, and space docking systems. In many scenarios, compliance modulation of PKMs is desirable, which can be achieved through active control or by introducing intrinsic physical compliance. The latter can be achieved by incorporating springs in the joint space (variable stiffness mechanisms) or using flexible links in parallel assembly (parallel continuum robots, or PCRs).

Cosserat rod theory is used to study PCRs, where flexible links are implemented as slender rods. Previous studies have investigated Stewart Gough type PCRs by formulating static forward and inverse kinematics problems using Cosserat-rod models with coupled boundary conditions. Improvements have been made in computing the error Jacobian and introducing a generalized framework for various kinematic configurations.

This paper presents the kinetostatic analysis of a novel 6-RUS PCR using Cosserat rod theory. The authors formulate boundary conditions for solving the forward and inverse kinetostatics of the mechanism and provide position and stiffness analysis. They also provide insight into the range of motion through workspace evaluation for the PCR.

The paper's organization section outlines the structure and content of the upcoming sections. Section 2 covers the mathematical foundations of Cosserat rod theory as it applies to modeling PCR, based on previous work. Section 3 focuses on deriving the boundary conditions needed for the forward and inverse kinematics and statics models of a specific type of PCR with 6 RUS. Section 4 presents the results, including analyses of the robot's workspace, trajectory following capabilities, and axial stiffness. The paper concludes in Section 5 with a summary and discussion of future research directions.

Mathematical Background

The paper describes a robot with n elastic rods connecting the end effector (EE) to the base platform. Each rod's shape is defined by its spatial centerline position, represented by the function p_i(s_i) in 3D space. The centerline represents the rod's tangent direction, and the rod can have bending in the x and y axes, as well as torsion about the z-axis. The rod's state includes a 3-DOF orientation, denoted by R_i(s_i) in the SO(3) group. These functions depend on an arc length parameter s_i, which represents the length along the centerline. The total length of the i-th rod is l_i, and both s and l are defined in a no-stress configuration to account for possible extension along the length. A homogeneous transformation H_i(s_i) in the SE(3) group is used to describe the entire rod using a material-attached frame.

The provided text describes the mathematical formulation for modeling the deformation of an elastic rod using the Cosserat rod theory. The key points are:

1. The change in position and orientation along the rod is defined by linear and angular rate vectors, v(s) and u(s), expressed in the local body coordinate system (material frame).

2. The remaining frames can be obtained by integrating the differential equations, given the initial reference frame and the strain vectors.

3. The classical Cosserat rod equations for static equilibrium are used to track the change in internal forces n(s) and moments m(s) along the rod, considering external distributed forces and moments per unit length.

4. A linear material constitutive relationship connects displacements to internal forces and moments through the mechanical stiffness matrices K_SE,i(s) and K_BT,i(s).

5. The reference strain vectors v_i^

   (s) represent the rest configuration, with u_i^*(s) expressing the pre-curved configuration.

6. The system of differential equations described by Eqs. (1) and (2) captures the rate of change of state variables p_i, R_i, n_i, and m_i with respect to the arc parameter s_i.

Kinetostatic Model of 6-RUS PCR

The paper describes the kinematics and statics of a parallel continuum robot (PCR) with elastic rods. The distal end of each rod is connected to an end effector platform with spherical joints, while the proximal end is attached to a motor-driven universal joint. Static equilibrium equations and boundary conditions are derived for the system.

An unknown vector B contains variables like forces, moments, and joint angles for each rod. The system is solved using shooting methods for both inverse kinematics (IK) and forward kinematics (FK) models. In the IK model, motor angles are computed given the end effector pose and external forces/moments. The FK model determines the end effector pose from given motor angles and external loads.

The shooting method iteratively integrates the governing ODEs for each rod as an initial value problem using guessed values for the unknown vector B. The residual error vector E is computed, and B is updated using the Jacobian matrix until convergence. Numerical integration and optimization are performed using Scipy library functions.

Results

The paper validates the boundary condition formulation for a titanium alloy (Ti6AL-4V) elastic rod with specific material properties and dimensions. The rod is connected to a crank at the base through a universal joint and to an end-effector (EE) platform via a spherical joint. The paper presents results from a kinetostatic model with specified tolerances and constraints.

The axial force response at the EE is evaluated using an inverse kinematics (IK) model, estimating a maximum compressing force of 267 N and an axial stiffness of 989.75 N/m. The rotation range of the EE platform is also analyzed using the IK model, considering negligible EE mass and sampling yaw angles between 0° and 90°.

The forward kinematics (FK) model is validated by comparing the EE position with samples from a reference helical trajectory under a constant 5 N load. The Euclidean distance error between the FK model and the reference trajectory is on the order of 1×10⁻⁷.

Lastly, the reachable workspace for the 6-RUS pseudo-rigid-body compliant robot (PCR) is estimated using the IK model and heuristically sampled points from a cylindrical volume. Valid solutions based on boundary condition tolerances are considered part of the reachable workspace. The mean computational time for the workspace samples is 3.82 seconds with a standard deviation of 1.15 seconds.

Conclusion

This paper presents a kinetostatic model for a 6-RUS parallel continuum robot (PCR) using Cosserat rod theory. Boundary conditions for both inverse kinematics (IK) and forward kinematics (FK) are formulated, and a shooting method is used to solve the initial value problem iteratively. The model is analyzed through simulations, including trajectory simulation, maximum load capacity, axial stiffness estimation, and range of motion evaluation for different end-effector rotations. A reachable workspace is estimated using the IK model, and motor angle ranges for each rod are visualized. The FK solution demonstrates an error of 1×10−7 under a constant 5 N load for a helical trajectory. Future work involves experimental validation of the model on a physical prototype.

Acknowledgement

Acknowledgements: The research in this paper was funded by the European Space Agency through the PACOMA project, with a subcontract from Airbus Defence & Space GmbH. The authors also acknowledge the valuable PCR tutorial and guidance provided by John Till on GitHub, particularly for deriving the boundary condition equations used in their proposed PCR.