Fixed velocity references and prepped code for letting physics handle the headache of who has updated what and where when jiggeling. I don't lik this, but seeing as i'm not in charge of this particular math i obey the commands :)
Merge branch 'master' of github.com:Torxed/python3-nodin