worked on simulation mode
Merge branch 'fuerte_dev' into groovy_dev
startup color and mode can now be defined by parameters
Merge branch 'groovy_dev' of git://github.com/ipa320/cob_driver into groovy_dev
added diagnostics to cob_light