Accurate and fast body pose estimation by three point position data

The paper presents an algorithm for estimating the pose of a rigid body in real-time. The method relies on the measurement of the location of three body points and minimizes the influence of measurement errors on the estimate. The method is applied to the solutions of the direct position analysis of the Stewart platform manipulator of type 6-3 and of the fully parallel spherical wrist. Comparison with other methods shows that the proposed algorithm performs better in terms of estimate accuracy and computation.

[1]  V. Parenti-Castelli,et al.  An Accurate Algorithm for the Real-Time Solution of the Direct Kinematics of 6–3 Stewart Platform Manipulators , 2002 .

[2]  Jorge Angeles,et al.  The kinematic decoupling of parallel manipulators using joint-sensor data , 2000, IEEE Trans. Robotics Autom..

[3]  Ka C. Cheok,et al.  Exact methods for determining the kinematics of a stewart platform using additional displacement sensors , 1993, J. Field Robotics.

[4]  Jean-Pierre Merlet,et al.  Parallel Robots , 2000 .

[5]  Vincenzo Parenti-Castelli,et al.  Real-Time Computation of the Actual Posture of the General Geometry 6-6 Fully-Parallel Mechanism Using Two Extra Rotary Sensors , 1998 .

[6]  Vincenzo Parenti-Castelli,et al.  Echelon form solution of direct kinematics for the general fully-parallel spherical wrist , 1993 .

[7]  K. C. Gupta,et al.  Accurate Determination of Object Position from Imprecise Data , 1998 .

[8]  Vincenzo Parenti-Castelli,et al.  Real-Time Direct Position Analysis of Parallel Spherical Wrists by Using Extra Sensor Data , 2004 .

[9]  Jorge Angeles,et al.  The decoupling of the direct kinematics of parallel manipulators using redundant sensors , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[10]  C. Spoor,et al.  Rigid body motion calculated from spatial co-ordinates of markers. , 1980, Journal of biomechanics.

[11]  Ming-Hwei Perng,et al.  Forward Kinematics of a General Fully Parallel Manipulator with Auxiliary Sensors , 2001, Int. J. Robotics Res..

[12]  C. Innocenti.  Closed-Form Determination of the Location of a Rigid Body by Seven In-Parallel Linear Transducers , 1998 .

[13]  A. J. Laub,et al.  A Linear Algebra Approach to the Analysis of Rigid Body Displacement From Initial and Final Position Data , 1982 .

[14]  Wan Kyun Chung,et al.  New resolution scheme of the forward kinematics of parallel manipulators using extra sensors , 1996 .

[15]  Jean-Pierre Merlet,et al.  Closed-form resolution of the direct kinematics of parallel manipulators using extra sensors data , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[16]  Bernard Roth,et al.  Finite-Position Theory Applied to Mechanism Synthesis , 1967 .

[17]  Jorge Angeles,et al.  Automatic Computation of the Screw Parameters of Rigid-Body Motions. Part I: Finitely-Separated Positions , 1986 .