Calculation of new camera position implemented

Only on theory (Not tested yet)