用c++程序重写matlab中比较耗时的部分