Added src and include, made GUI compile with QtCreator stuff, to keep the development going. Need to add compilation with ROS stuff, catkin_make