Servo rate limiting, cleaning and commenting code