11.07.2015 Views

Builders guide robot pacman.pdf

Builders guide robot pacman.pdf

Builders guide robot pacman.pdf

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

{}// calibrate nearest front sensor distanceFRONT_OBSTACLE = 0;output_bit(SENSOR_LED, 1);delay_ms(SENSOR_VALID_DELAY*10);set_adc_channel( OBSTACLE_FRONT );delay_us(10);FRONT_OBSTACLE += read_adc();output_bit(SENSOR_LED, 0);calibration_stage++;else if (calibration_stage == 1){// calibrate nearest acceptable left and farthest acceptable right// (before off-centre adjustment takes effect)MAX_LEFT = 0;output_bit(SENSOR_LED, 1);delay_ms(SENSOR_VALID_DELAY*10);set_adc_channel( OBSTACLE_LEFT );delay_us(10);MAX_LEFT += read_adc();output_bit(SENSOR_LED, 0);}calibration_stage++;effect)else if (calibration_stage == 2){// calibrate nearest acceptable right (before off-centre adjustment takesMAX_RIGHT = 0;MIDDLE_LEFT = 0;output_bit(SENSOR_LED, 1);delay_ms(SENSOR_VALID_DELAY*10);set_adc_channel( OBSTACLE_RIGHT );delay_us(10);MAX_RIGHT += read_adc();output_bit(SENSOR_LED, 0);calibration_stage++;}else if (calibration_stage == 3){// calibrate far left (no wall on left sensor)MIN_LEFT = 0;output_bit(SENSOR_LED, 1);delay_ms(SENSOR_VALID_DELAY*10);set_adc_channel( OBSTACLE_LEFT );delay_us(10);MIN_LEFT += read_adc();output_bit(SENSOR_LED, 0);}calibration_stage++;else if (calibration_stage == 4){// calibrate far right (no wall on right sensor)MIN_RIGHT = 0;output_bit(SENSOR_LED, 1);delay_ms(SENSOR_VALID_DELAY*10);set_adc_channel( OBSTACLE_RIGHT );delay_us(10);MIN_RIGHT += read_adc();output_bit(SENSOR_LED, 0);}calibration_stage++;}}else if (calibration_stage == 5){initial_start = 1;}delay_ms(5000);for( ; ; )

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!