Matlab trigonometric system of equations solver