Matlab calculation plane vector