Physics works !

After 5 hours of maths, I have my physics engine done ! Need to sleep now...

screen1.png