Robot Template
-Added time controled loop for read encoder, sensor and send command to keep robot moving
-Added method for robot to go straight, rotate and turn(unfinished)
-Added speed auto compensation feature to keep moving result accurate
-Command Queue might be added in the future, use array instead temporarily