Collision code done, current commented test function due to error.