add color detection routine
add debug blocks around color sensing, switch motor pin constants for new wiring