Real time inverse kinematics for general 6R manipulators