SimpleRobot works(it already did, I just hadn't tested it)
Added (eventual) support for setting control modes, this does not work at the moment(most likely due to all the commented out semaphores and taskexecutors)
Authored by: spectare 2012-04-12
Parent: [r4]
Child: [r6]