Fixed unit movement speeds
Some code cleanup and physics fixes
Fixed weapon raytests