Add the same compile flags as with ros2_controllers and fix errors

Add the same compile flags as with ros2_controllers and fix errors #111