@jarubank the nan is a wrong data. I have update the code, added a nan value filter . Use git pull, get the new code, then catkin_make .

https://github.com/BluewhaleRobot/xqserial_server/tree/lungu