输出方程：Y = Q01 * Q02 * (Q03)' ；驱动方程：D3 = （Q02）' ；D2 = （Q01）' ；D1 = Q03 + Q01 *（Q02）' ；状态方程：Qn+1 = D；余下自己去写吧；
