Ground Collision part fix

Now places ground correctly. boxes are however still placed in the 0,0,0
position at the time of calculation (see the debug run with currently
set speed), giving problems when the boxes are then moved