有MATLAB和C和C++实现