Added function to get position and orientation with orientation as quaternion.