More refactoring, but now it is really almost ready for testing
Mistry's suggestion from IROS 2007...
Indeed: the task prioritization based on [Mistry, 2007] seems superior
to [Baerlocher, 2001], at least in this test case for conflicting
tasks. And that even without carefully tuning lambda.