Complex chasing method solution three diagonal matrix equation c/c++ source code