#include <stdio.h>
#include <stdlib.h>

#include "comms.h"
#include "hardware.h"
#include "log.h"
#include "robod.h"

#define MAX_SERVOS 32
#define LOOP_DELAY 0.5

typedef struct servo {
    char channel;
    char enabled;
    srv_pulse_t cur_pulse;
    srv_pulse_t max_low_pulse;
    srv_pulse_t max_high_pulse;
} servo;

int main(int argc, const char* argv) {
    servo servos[MAX_SERVOS];
    servo* srv = &servos[0];
    int i = 0;
    // if (!robodaemon()) { exit(0);}
    for(i = 0; i < MAX_SERVOS; i++) {
        srv.channel = i;
        srv = srv >> sizeof(servo);
    }
    srv = &servos[0];
    //for(;;) {
        sleep(LOOP_DELAY);
        set_servo((servo*)servos);
    //}
    return 0;
}