Catkin_lint modifications
*Init bug fix
*Schunk bug fix