Large improvements to vision code: tomorrow need to go through certain logic sections more carefully (realized I may have calculated some slopes wrong) also want to work on improving the filtering technique for the grass at IGVC and tweak robotPos and steering constants