Added MathAdv with lengthDir methods
AI methods refactoring
CollisionManager refactoring
AI refactoring