Fixed UDP issues, should be ready to plug into XBEE setup