Added ThreeColorSensor support (black+white+green), and a test program