Fix private nodehandle bug
Fix linking
No more roslib
Most tests pass