Implemented pitch/roll/yaw. Fixed z-axis distance shifting.