fixed the controller code. It was a bad type with the XMega_Message. The ROS side seems to be OK now. XMEGA side still is unresponsive