Add code for Time of Light model 400f

[jckitkat]

the semi-functional program for the ToF-400f sensor has been added to the appropriate branch. the program returns the correct distance +/- 10 mm every 500 milliseconds, but returns an arbitrarily high integer every few cycles. I have attempted to add my own functions to the program, but to no avail. i am currently working on translating all the chinese comments into english for readability

the original program can be found here

and the datasheet can be found here

[davidpolito]

Part of learning the sensors is also to learn how clean the data is. Don't bother cleaning up the data until we select which sensors to put on the robot.