added _wait_sensorread in controller.py and construct distFL and dist FR in robot.py
added _wait_sensorread in controller.py and construct distFL and dist FR in robot.py

ksurct/MercuryRoboticsEmbedded2016,ksurct/MercuryRoboticsEmbedded2016,ksurct/MercuryRoboticsEmbedded2016