Colony

#include "test_rangefinders.h"

#include "global.h"

#include "comm_robot.h"

void test_rangefinder (uint8_t num)

{

        if (num>4) return;

        usb_puts("# Testing rangefinder ");

        usb_puti(num);

        usb_puts(NL);

        //        rotate to position

        //        

        //        for (wall positions up/down)

        //        {

        //                set wall position

        //                send (read)

        //                receive (data)

        //        }

        //send data

}

void test_rangefinder_all (void)

{

        usb_puts("# Testing rangefinders" NL);

        for (int n=0; n<5; ++n)

                test_rangefinder (n);

        usb_puts("# Testing rangefinders finished" NL);

}