servos.hpp

#ifndef SERVOS_H
#define SERVOS_H

#include <stdint.h>

#define NUM_SERVOS 3

/**
 * Initialises the servos.
 */
void initServos();

/**
 * Sets the angle of a servo.
 * 
 * @param servo     the index of the servo to control
 * @param arcMin    the angle of the servo in arc-minutes
 */
void setServoAngle(uint8_t servo, int16_t arcMin);

/**
 * Gets the angle of a servo.
 */
int16_t getServoAngle(uint8_t servo);

/**
 * Writes the servo values out to the servos.
 */
void updateServos();

#endif /* SERVOS_H */