first steps to port to catkin
make it compile again...
not working atm
fix missing $