-#ifndef USE_USB
- /* in usb mode, it's done in usb callback */
- printf_P(PSTR("\r\n"));
- rdline_newline(&xbeeboard.rdl, xbeeboard.prompt);
-#endif
- callout_manager_init(&cm, get_time_ms);
- callout_reset(&cm, &t1, 500, PERIODICAL, do_led_blink, NULL);
+ spi_servo_init();
+ beep_init();
+
+ callout_mgr_init(&cm, get_time_ms);
+ //callout_reset(&cm, &t1, 500, PERIODICAL, do_led_blink, NULL);