int main(int argc, char *argv[]) {
//init program
led_set_blue(ledb_vals[0] | ledb_vals[1]);
button_wait(0);
roombaInit();
programRun();
/*while (true) {
intToAscii(query_sensor(PACKET_INFRARED_CHARACTER_OMNI), roomba_sevenseg_digits);
write_sevenseg_digits();
my_msleep(50);
}*/
return 0;
}
void show_color(unsigned char dig){
switch(dig){
case 0:
led_set_yellow(POWER);
led_set_black();
led_set_black();
led_set_black();
led_set_black();
sound_start(dig);
break;
case 1:
led_set_black();
led_set_red(POWER);
led_set_black();
led_set_black();
led_set_black();
sound_start(dig);
break;
case 2:
led_set_black();
led_set_black();
led_set_green(POWER);
led_set_black();
led_set_black();
sound_start(dig);
break;
case 3:
led_set_black();
led_set_black();
led_set_black();
led_set_blue(POWER);
led_set_black();
sound_start(dig);
break;
}
}
int main(int argc, char *argv[]) {
//led_set_blue(ledb_vals[0] | ledb_vals[1]);
//button_wait(0);
led_set_blue(ledb_vals[2] | ledb_vals[3]);
//ir_sender_setup();
//ir_sender_set((ROOMBA_ID&0x03)<<4 | IR_SENDER_ID | IR_LED_LEFT, (ROOMBA_ID&0x03)<<4 | IR_SENDER_ID | IR_LED_CENTER, (ROOMBA_ID&0x03)<<4 | IR_SENDER_ID | IR_LED_RIGHT, (ROOMBA_ID&0x03)<<4 | ir_next_base_id | IR_LED_NEAR);
IOWR32(A_IR_SENDER, 0x4, base_id_codes[base_id-1] | 0x5);
//IOWR32(A_IR_SENDER, 0x4, 0xF8F4F2F1);
//ir_sender_set(0x80 | IR_LED_RIGHT, 0x80 | IR_LED_CENTER, 0x80 | IR_LED_LEFT, 0x80 | IR_LED_NEAR);
ir_sender_on();
while(true) {
ir_sender_off();
my_msleep(500);
ir_sender_on();
my_msleep(50);
}
return 0;
}
