Fixed build problem

This fixes ROS build scripts and roboteq compilation problems