Adding line sensor code and correction function.  Fixing motor test.