Xmega Sim - Impliment ROS side simulation