Test Xbee connection with joystick, add save/load for config