Change to Vector3Stamped, correct roll and pitch.