IR sensors working, wheel encoders coming along.  Code needs clean up