- CDC_Device_USBTask(&VirtualSerial1_CDC_Interface);
- CDC_Device_USBTask(&VirtualSerial2_CDC_Interface);
- USB_USBTask();
+ cmdline_init();
+ spi_servo_init();
+ beep_init();
+
+ printf_P(PSTR("\r\n"));
+ rdline_newline(&xbeeboard.rdl, xbeeboard.prompt);
+
+ callout_manager_init(&cm, get_time_ms);
+ //callout_reset(&cm, &t1, 500, PERIODICAL, do_led_blink, NULL);
+
+ /* initialize libxbee */
+ err = xbee_init();
+ if (err < 0)
+ return -1;
+
+ xbee_dev = &dev;
+
+ /* open xbee device */
+ if (xbee_open(xbee_dev, xbee_file) < 0)
+ return -1;
+
+ /* register default channel with a callback */
+ if (xbee_register_channel(xbee_dev, XBEE_DEFAULT_CHANNEL,
+ xbeeapp_rx, NULL) < 0) {
+ fprintf(stderr, "cannot register default channel\n");
+ return -1;