debug function, straight changes

added displayColors; in process of debugging goStraight

known issues: sensors will sometimes read wrong color (move closer to ground)