working in catkin

Signed-off-by: peterheim1 <peter.heim1066@gmail.com>