Clean up the code a bit, add TargetPIDCommand to share code between tilt & turn.