Rewrote camera and 3D math

YAYAYAYAYAY