Exponential Coordinates Kinematics Package for Robot