Remove dead code.
Code cleanup
Read camera when on robot.
Use polyval for polynomial evaluation.