Added stop_type in srv file. Added some brains to the node.
Merge branch 'logic_controldraft' into logic
New brain and motion controller work with each other. Quite buggy.