Mid level control code

Dependencies:   ros_lib_kinetic

unknown revision 'shortlog'