Mid level control code

Dependencies:   ros_lib_kinetic

main.cpp/shortlog@e5acb2183d4e: not found in manifest