Colony

Revision 1094

simulating rangefinder and smart run around

changed the position of IR sensors defined in libsim
libsim and libdragonfly use different numbering for IRs (#418, #419)
added smart_run_around to template, right now it just hits wall, backs
up then segfaults

#include <dragonfly_lib.h>

#include "smart_run_around_fsm.h"

int main(void)

{

	dragonfly_init(ALL_ON);

	bom_leds_on(BOM_ALL);

	motor1_set(1, 200);

	motor2_set(1, 150);

	//bom_leds_on(BOM_ALL);

	//motor1_set(1, 210);

	//motor2_set(1, 200);

	run_around_init();

	while(1){

       simulator_do();

  }

		run_around_FSM();

       		simulator_do();

  	}

	return 0;

}

Also available in: Unified diff