More work on improved collision box, Added unit testing for Cuboid