Added the diver kinematics URDF testing node. Added the shoulder DOFs.