Theoretical method for calculating relative joint geometry of assembled robot arms

Equations are developed to extract the relative joint parameters of an assembled robot arm. Specifically, the Denavit-Hartenberg parameters, which completely characterize the relative joint geometry, are calculated. These parameters are needed to control the hand of the robot arm by resolved rate. As an example, the parameter extraction equations are used with perfect simulated data (no measurement noise) obtained from a mathematical model of a six-degree-of-freedom robot arm. For an actual application, measurement data needed to estimate the relative joint parameters can be generated by moving a robot arm to different positions, measuring the location of the hand (or other extension) in base coordinates, and recording the corresponding joint angles.