// ssdata.cpp// 编译: g -stdc11 -O2 ssdata.cpp -o ssdata// 运行: ./ssdata (Linux/macOS) 或 ssdata.exe (Windows)#includeiostream#includevector#includeiomanip#includestdexcept#includecmath#includestring// // 轻量矩阵类 (仅实现本示例所需功能, 不依赖任何第三方库)// classMatrix{public:introws;intcols;std::vectordoubledata;// 行优先存储Matrix():rows(0),cols(0){}Matrix(intr,intc,doubleinit0.0):rows(r),cols(c),data(r*c,init){}doubleoperator()(inti,intj){returndata[i*colsj];}doubleoperator()(inti,intj)const{returndata[i*colsj];}staticMatrixZero(intr,intc){returnMatrix(r,c,0.0);}staticMatrixIdentity(intn){MatrixI(n,n,0.0);for(inti0;in;i)I(i,i)1.0;returnI;}voidprint(conststd::stringname)const{std::coutname \n;for(inti0;irows;i){for(intj0;jcols;j){doublev(*this)(i,j);if(std::abs(v)1e-12)v0.0;// 消除 -0 显示std::coutstd::setw(10)std::setprecision(6)std::fixedv;if(j1cols)std::cout ;}std::cout\n;}}};// // 状态空间模型类 (对应 MATLAB ssdata 的功能)// classStateSpaceModel{public:Matrix A,B,C,D;doubleTs;// 采样时间, 0 表示连续时间StateSpaceModel():Ts(0.0){}StateSpaceModel(constMatrixA_,constMatrixB_,constMatrixC_,constMatrixD_,doubleTs_0.0):A(A_),B(B_),C(C_),D(D_),Ts(Ts_){validateDimensions();}// 从传递函数构造 (可控标准型), 仅支持 SISO// num / den: 系数从最高次到最低次staticStateSpaceModelfromTransferFunction(conststd::vectordoublenum,conststd::vectordoubleden,doubleTs0.0){if(den.empty()||std::abs(den[0])1e-12)throwstd::invalid_argument(Denominator leading coefficient must be non-zero.);intnstatic_castint(den.size())-1;// 系统阶数if(n0)throwstd::invalid_argument(Transfer function must have order 1.);// 规范化分母std::vectordoublea(den.size());for(size_t i0;iden.size();i)a[i]den[i]/den[0];// 分子补齐到 n1 位std::vectordoubleb(n1,0.0);intoffset(n1)-static_castint(num.size());for(size_t i0;inum.size();i)b[offseti]num[i]/den[0];Matrix AMatrix::Zero(n,n);Matrix BMatrix::Zero(n,1);Matrix CMatrix::Zero(1,n);Matrix DMatrix::Zero(1,1);// 友矩阵形式 (可控标准型)for(inti0;in;i)A(n-1,i)-a[n-i];// 最后一行for(inti0;in-1;i)A(i,i1)1.0;B(n-1,0)1.0;// 输出矩阵for(inti0;in;i)C(0,i)b[n-i]-a[n-i]*b[0];D(0,0)b[0];returnStateSpaceModel(A,B,C,D,Ts);}// 提取状态空间数据 —— 对应 MATLAB 的 ssdatavoidssdata(MatrixA_out,MatrixB_out,MatrixC_out,MatrixD_out)const{A_outA;B_outB;C_outC;D_outD;}voidssdata(MatrixA_out,MatrixB_out,MatrixC_out,MatrixD_out,doubleTs_out)const{ssdata(A_out,B_out,C_out,D_out);Ts_outTs;}voidvalidateDimensions()const{if(A.rows!A.cols)throwstd::invalid_argument(A must be square.);intnA.rows;if(B.rows!n)throwstd::invalid_argument(B must have n rows.);if(C.cols!n)throwstd::invalid_argument(C must have n columns.);if(D.rows!C.rows||D.cols!B.cols)throwstd::invalid_argument(D must be p x m.);}};// // 主程序// intmain(){try{// 示例: G(s) (2s 3) / (s^2 2s 5)std::vectordoublenum{2,3};std::vectordoubleden{1,2,5};StateSpaceModel sysStateSpaceModel::fromTransferFunction(num,den);Matrix A,B,C,D;doubleTs0.0;sys.ssdata(A,B,C,D,Ts);// 对应 MATLAB: [A,B,C,D,Ts] ssdata(sys)A.print(A);std::cout\n;B.print(B);std::cout\n;C.print(C);std::cout\n;D.print(D);std::cout\n;std::coutstd::defaultfloat;// 恢复默认浮点显示std::coutTs Tsstd::endl;}catch(conststd::exceptione){std::cerrError: e.what()std::endl;return1;}return0;}