Branch for servo motor

Dependencies:   MPU6050-DMP mbed ros_lib_kinetic

Fork of AGV_SMT by Weber Yang

ros_lib_kinetic.lib/shortlog@f9e9662d26bf: not found in manifest