servoboard: firmware: fixed all warnings