First implementation of function replacing and checking
Fix unitToPixel
Draw coordinate system