Added more code for side and angled sensor

Dependencies:   QEI2 PID Watchdog VL53L1X_Filter BNOWrapper ros_lib_kinetic

ros_lib_kinetic.lib/shortlog/shortlog@9858a580b3d7: not found in manifest