Cleaned up some nasty calculations and wrote additional descriptions for the physical calculations on angular impulse.

Signed-off-by: Martin Grönlund <martingronlund@live.se>