Catkin_lint modifications

*Init bug fix
*Schunk bug fix