completed diffdrive.cpp and color_sensor.cpp

have to test their working