Colony

#include "test_rangefinders.h"

#include "global.h"

#include "comm_robot.h"

void test_rangefinders (void)

{

        usb_puts("# Testing rangefinders" NL);

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

        {

                usb_puts("# Testing rangefinder ");

                usb_puti(n);

                usb_puts(NL);

        //        rotate to position

        //        

        //        for (wall positions up/down)

        //        {

        //                set wall position

        //                send (read)

        //                receive (data)

        //        }

        }

        //send data

        usb_puts("# Testing rangefinders finished" NL);

}