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( ; ; )