Fixed heightmap rendering | fixed scaling for goals in MATLAB