Implemented 3D to 2D projection

Also added coordinate system conversion