Got it working.
Working on transformations.
Added file.
Fixed affine transform.
Fixed the screen to world.