obsv_mat - observability matrix
obsv_mat returns the observability matrix:
O=[C; CA; CA^2;...; CA^(n-1) ]