[Kinematics Fix]: Small fixes

Also 20% fix for AABB collision detection....