An easy way to set team color without adding any switches to your bot is to use the wheel on the older flight stick joysticks if you are using those. The wheel isnt used for any normal robot control, so you can say turn it all the way forward for blue, and all the way backward for red. Then, in your code say:
Code:
if(p1_wheel > 210) color = blue;
else color=red;
In this the color would default to red, unless the wheel was turned towards the front.