Cleanup into services
Merge pull request #98 from rickcarlino/master

Better logging and statuses, cleaner movement controller