Fixed prototype collision engine. implemented velocity, next to do is MTV calculation.