Created catkin package and built some libraries