completed the 6DOF  joint using small angular apprximation