Adding service files
Included service-files in CMakeLists
Test for yaw and thrust now working
Added a description of the startphase-procedure
Starting on adding the service-methods
Procedure.txt -> readme
Inserted open- and close- Service, untested
Small fix. Needs testing before further coding.

Changed cmakelists.txt, package.xml. Still does not run here... Unclear if many services in one class will actually work. To test.
Added "Header header" ... might be the fix
Changed logging
Changed logging
Commented out some code to make it runnable again
Changed logging
Added debug code
Removed header for testing purpose
Removed logging vars for testing purpose
Removed wrong line
Changed logging
Addded more test code
Changed testcode