I was bored, fixed demo so it actually works. Plus I simplified the Physics code a bit.