Gevonden

gisteren nog een paar uur zitten zoeken, niets kunnen vinden, net in de
trein het plan nog 1 keer doorlopen en in de eerste iteratie gevonden...
qdot !=Q war zoiets betekent als de forces moeten ook in de berekening
worden meegenomen, gelijk ook ff rodconstraint gemakt:)