Colony

#include "test_motors.h"

#include "global.h"

void test_motors (void)

{

        usb_puts("Testing motors" NL);

        // reset_encoders ();

        //for (num measurements)

        //{

        //        send (turn motor on for time)

        //        wait (done)

        //        wait_stopped

        //        send (read encoders)

        //        receive (data)

        //        read encoders

        //}

        //send data

        usb_puts("Testing motors finished" NL);

}