empc_sts_10k_tracking.h

2812例程以及 控制直流无刷电机程序

-1.236611e-002,	0.000000e+000,	0.000000e+000,	-9.991883e-001,	3.604272e-003,
3.430000e+002,	3.440000e+002,	-3.429094e-002,	-1.714547e-002,	1.236611e-002,
0.000000e+000,	0.000000e+000,	9.991883e-001,	2.518674e-002,	3.450000e+002,
3.460000e+002,	3.429094e-002,	1.714547e-002,	-1.236611e-002,	0.000000e+000,
0.000000e+000,	-9.991883e-001,	3.604272e-003,	3.470000e+002,	3.480000e+002,
-1.714664e-002,	-3.429327e-002,	-4.122316e-003,	9.992562e-001,	0.000000e+000,
0.000000e+000,	1.800100e-002,	3.490000e+002,	3.500000e+002,	1.714664e-002,
3.429327e-002,	4.122316e-003,	0.000000e+000,	0.000000e+000,	-9.992562e-001,
-1.800100e-002,	3.510000e+002,	3.520000e+002,	6.807015e-001,	-0.000000e+000,
1.636511e-001,	-0.000000e+000,	-7.140475e-001,	-0.000000e+000,	6.884460e-001,
3.530000e+002,	3.540000e+002,	0.000000e+000,	7.071068e-001,	0.000000e+000,
0.000000e+000,	-7.071068e-001,	0.000000e+000,	0.000000e+000,	3.550000e+002,
3.560000e+002,	-1.714664e-002,	-3.429327e-002,	-4.122316e-003,	9.992562e-001,
-0.000000e+000,	-0.000000e+000,	-1.080636e-002,	3.570000e+002,	3.580000e+002,
6.807015e-001,	-0.000000e+000,	1.636511e-001,	-0.000000e+000,	-7.140475e-001,
-0.000000e+000,	6.884460e-001,	3.590000e+002,	-1.000000e+000,	-1.714664e-002,
-3.429327e-002,	-4.122316e-003,	0.000000e+000,	0.000000e+000,	9.992562e-001,
-2.518845e-002,	3.600000e+002,	3.610000e+002,	1.714664e-002,	3.429327e-002,
4.122316e-003,	0.000000e+000,	0.000000e+000,	-9.992562e-001,	-3.604517e-003,
3.620000e+002,	3.630000e+002,	1.714664e-002,	3.429327e-002,	4.122316e-003,
0.000000e+000,	0.000000e+000,	-9.992562e-001,	-1.800100e-002,	3.640000e+002,
3.650000e+002,	-1.714664e-002,	-3.429327e-002,	-4.122316e-003,	0.000000e+000,
0.000000e+000,	9.992562e-001,	-2.518845e-002,	3.660000e+002,	3.670000e+002,
-1.714664e-002,	-3.429327e-002,	-4.122316e-003,	9.992562e-001,	-0.000000e+000,
-0.000000e+000,	-1.080636e-002,	3.680000e+002,	3.690000e+002,	-1.714664e-002,
-3.429327e-002,	-4.122316e-003,	0.000000e+000,	0.000000e+000,	9.992562e-001,
-2.518845e-002,	3.700000e+002,	3.710000e+002,	-1.993419e-001,	-3.291885e-002,
-4.792487e-002,	9.592076e-001,	1.918415e-001,	-0.000000e+000,	-6.942553e-002,
-1.401000e+003,	3.720000e+002,	3.597088e-002,	1.798544e-002,	0.000000e+000,
0.000000e+000,	0.000000e+000,	-9.991910e-001,	0.000000e+000,	3.730000e+002,
3.740000e+002,	3.597088e-002,	1.798544e-002,	0.000000e+000,	-9.991910e-001,
0.000000e+000,	0.000000e+000,	0.000000e+000,	3.750000e+002,	3.760000e+002,
3.597088e-002,	1.798544e-002,	0.000000e+000,	-9.991910e-001,	0.000000e+000,
0.000000e+000,	0.000000e+000,	3.770000e+002,	3.780000e+002,	-3.432662e-002,
-1.716331e-002,	8.252649e-003,	-9.992287e-001,	-0.000000e+000,	-9.992287e-004,
4.753083e-002,	3.790000e+002,	3.800000e+002,	-0.000000e+000,	-6.900039e-001,
-0.000000e+000,	-0.000000e+000,	7.238056e-001,	-0.000000e+000,	2.635709e-001,
3.810000e+002,	3.820000e+002,	-0.000000e+000,	-6.900039e-001,	-0.000000e+000,
-0.000000e+000,	7.238056e-001,	-0.000000e+000,	2.635709e-001,	3.830000e+002,
-1.146000e+003,	-3.429240e-002,	-1.714620e-002,	8.244421e-003,	-9.992307e-001,
-0.000000e+000,	-0.000000e+000,	4.749784e-002,	3.840000e+002,	3.850000e+002,
0.000000e+000,	7.071068e-001,	0.000000e+000,	0.000000e+000,	-7.071068e-001,
0.000000e+000,	0.000000e+000,	3.860000e+002,	3.870000e+002,	-3.432662e-002,
-1.716331e-002,	8.252649e-003,	-9.992287e-001,	-0.000000e+000,	-9.992287e-004,
4.753083e-002,	3.880000e+002,	3.890000e+002,	-3.429240e-002,	-1.714620e-002,
8.244421e-003,	-9.992307e-001,	0.000000e+000,	0.000000e+000,	1.869121e-002,
3.900000e+002,	3.910000e+002,	-3.429240e-002,	-1.714620e-002,	8.244421e-003,
0.000000e+000,	0.000000e+000,	-9.992307e-001,	6.187956e-002,	3.920000e+002,
3.930000e+002,	-6.900039e-001,	0.000000e+000,	0.000000e+000,	0.000000e+000,
7.238056e-001,	0.000000e+000,	0.000000e+000,	3.940000e+002,	3.950000e+002,
-1.716331e-002,	-3.432662e-002,	-8.252649e-003,	-9.992287e-001,	-0.000000e+000,
-9.992287e-004,	-4.753083e-002,	3.960000e+002,	3.970000e+002,	-1.714620e-002,
-3.429240e-002,	-8.244421e-003,	-9.992307e-001,	-0.000000e+000,	-0.000000e+000,
-4.749784e-002,	3.980000e+002,	3.990000e+002,	-7.071068e-001,	0.000000e+000,
0.000000e+000,	0.000000e+000,	7.071068e-001,	0.000000e+000,	0.000000e+000,
4.000000e+002,	4.010000e+002,	-1.714664e-002,	-3.429327e-002,	4.122316e-003,
-9.992562e-001,	-0.000000e+000,	-0.000000e+000,	2.372793e-002,	4.020000e+002,
4.030000e+002,	-1.714664e-002,	-3.429327e-002,	4.122316e-003,	-9.992562e-001,
-0.000000e+000,	-0.000000e+000,	2.371353e-002,	-5.520000e+002,	-1.000000e+000,
-1.714664e-002,	-3.429327e-002,	4.122316e-003,	-9.992562e-001,	-0.000000e+000,
-0.000000e+000,	2.377112e-002,	4.040000e+002,	4.050000e+002,	-3.597088e-002,
-1.798544e-002,	0.000000e+000,	-9.991910e-001,	0.000000e+000,	0.000000e+000,
0.000000e+000,	4.060000e+002,	4.070000e+002,	-3.432662e-002,	-1.716331e-002,
8.252649e-003,	-9.992287e-001,	-0.000000e+000,	-9.992287e-004,	4.753083e-002,
4.080000e+002,	4.090000e+002,	-0.000000e+000,	-6.900039e-001,	-0.000000e+000,
-0.000000e+000,	7.238056e-001,	-0.000000e+000,	2.635709e-001,	4.100000e+002,
4.110000e+002,	-0.000000e+000,	-6.900039e-001,	-0.000000e+000,	-0.000000e+000,
7.238056e-001,	-0.000000e+000,	2.635709e-001,	4.120000e+002,	-1.146000e+003,
-3.429240e-002,	-1.714620e-002,	8.244421e-003,	-9.992307e-001,	-0.000000e+000,
-0.000000e+000,	4.749784e-002,	4.130000e+002,	4.140000e+002,	-3.429240e-002,
-1.714620e-002,	8.244421e-003,	-9.992307e-001,	-0.000000e+000,	-0.000000e+000,
4.745465e-002,	-1.146000e+003,	-2.720000e+002,	-3.429240e-002,	-1.714620e-002,
8.244421e-003,	-9.992307e-001,	-0.000000e+000,	-0.000000e+000,	4.746905e-002,
4.150000e+002,	4.160000e+002,	-3.429240e-002,	-1.714620e-002,	8.244421e-003,
-9.992307e-001,	-0.000000e+000,	-0.000000e+000,	4.751224e-002,	-1.146000e+003,
-2.720000e+002,	-3.429240e-002,	-1.714620e-002,	8.244421e-003,	-9.992307e-001,
-0.000000e+000,	-0.000000e+000,	4.749784e-002,	4.170000e+002,	4.180000e+002,
6.900039e-001,	-0.000000e+000,	-0.000000e+000,	-0.000000e+000,	-7.238056e-001,
-0.000000e+000,	2.635709e-001,	4.190000e+002,	4.200000e+002,	-1.714664e-002,
-3.429327e-002,	4.122316e-003,	-9.992562e-001,	0.000000e+000,	0.000000e+000,
3.813881e-002,	4.210000e+002,	4.220000e+002,	6.900039e-001,	-0.000000e+000,
-0.000000e+000,	-0.000000e+000,	-7.238056e-001,	-0.000000e+000,	2.635709e-001,
4.230000e+002,	4.240000e+002,	-1.714664e-002,	-3.429327e-002,	4.122316e-003,
-9.992562e-001,	-0.000000e+000,	-0.000000e+000,	2.375672e-002,	4.250000e+002,
4.260000e+002,	-1.714664e-002,	-3.429327e-002,	4.122316e-003,	-9.992562e-001,
0.000000e+000,	0.000000e+000,	3.813881e-002,	4.270000e+002,	4.280000e+002,
6.807015e-001,	-0.000000e+000,	-1.636511e-001,	-0.000000e+000,	-7.140475e-001,
-0.000000e+000,	-6.825252e-001,	4.290000e+002,	4.300000e+002,	0.000000e+000,
0.000000e+000,	1.000000e+000,	0.000000e+000,	0.000000e+000,	0.000000e+000,
5.759600e+000,	4.310000e+002,	4.320000e+002,	1.714664e-002,	3.429327e-002,
-4.122316e-003,	9.992562e-001,	0.000000e+000,	0.000000e+000,	-9.345843e-003,
4.330000e+002,	4.340000e+002,	1.715435e-002,	-1.715435e-002,	0.000000e+000,
9.997057e-001,	0.000000e+000,	0.000000e+000,	1.008423e-002,	4.350000e+002,
4.360000e+002,	-1.799417e-002,	1.799417e-002,	0.000000e+000,	-9.996762e-001,
0.000000e+000,	0.000000e+000,	0.000000e+000,	4.370000e+002,	4.380000e+002,
-1.715435e-002,	1.715435e-002,	0.000000e+000,	-9.997057e-001,	0.000000e+000,
0.000000e+000,	3.312465e-002,	4.390000e+002,	4.400000e+002,	1.715435e-002,
-1.715435e-002,	0.000000e+000,	0.000000e+000,	0.000000e+000,	9.997057e-001,
1.008423e-002,	4.410000e+002,	4.420000e+002,	-1.715435e-002,	1.715435e-002,
0.000000e+000,	0.000000e+000,	0.000000e+000,	-9.997057e-001,	1.872169e-002,
4.430000e+002,	4.440000e+002,	-5.773503e-001,	-5.773503e-001,	0.000000e+000,
0.000000e+000,	-5.773503e-001,	0.000000e+000,	0.000000e+000,	4.450000e+002,
4.460000e+002,	-1.715435e-002,	1.715435e-002,	0.000000e+000,	-9.997057e-001,
0.000000e+000,	0.000000e+000,	3.312465e-002,	4.470000e+002,	4.480000e+002,
1.715420e-002,	-1.715420e-002,	4.124135e-003,	0.000000e+000,	0.000000e+000,
9.996972e-001,	3.960240e-002,	4.490000e+002,	4.500000e+002,	-3.429094e-002,
-1.714547e-002,	-1.236611e-002,	-9.991883e-001,	-0.000000e+000,	-0.000000e+000,
-4.965407e-002,	4.510000e+002,	4.520000e+002,	-3.429094e-002,	-1.714547e-002,
-1.236611e-002,	-9.991883e-001,	-0.000000e+000,	-0.000000e+000,	-4.966847e-002,
-1.146000e+003,	-2.720000e+002,	-3.429094e-002,	-1.714547e-002,	-1.236611e-002,
-9.991883e-001,	-0.000000e+000,	-0.000000e+000,	-4.962528e-002,	4.530000e+002,
4.540000e+002,	-3.429094e-002,	-1.714547e-002,	-1.236611e-002,	-9.991883e-001,
-0.000000e+000,	-0.000000e+000,	-4.961088e-002,	-1.146000e+003,	-2.720000e+002,
-3.429094e-002,	-1.714547e-002,	-1.236611e-002,	-9.991883e-001,	0.000000e+000,
0.000000e+000,	-3.524417e-002,	4.550000e+002,	4.560000e+002,	-3.429094e-002,
-1.714547e-002,	-1.236611e-002,	-9.991883e-001,	-0.000000e+000,	-0.000000e+000,
-4.962528e-002,	4.570000e+002,	4.580000e+002,	-5.773503e-001,	-5.773503e-001,
0.000000e+000,	0.000000e+000,	-5.773503e-001,	0.000000e+000,	0.000000e+000,
4.590000e+002,	4.600000e+002,	-5.773503e-001,	-5.773503e-001,	0.000000e+000,
0.000000e+000,	-5.773503e-001,	0.000000e+000,	0.000000e+000,	4.610000e+002,
4.620000e+002,	-1.715420e-002,	1.715420e-002,	-4.124135e-003,	-9.996972e-001,
0.000000e+000,	0.000000e+000,	-2.519957e-002,	4.630000e+002,	4.640000e+002,
1.715420e-002,	-1.715420e-002,	4.124135e-003,	9.996972e-001,	-0.000000e+000,
-0.000000e+000,	1.081113e-002,	4.650000e+002,	4.660000e+002,	-1.715420e-002,
1.715420e-002,	-4.124135e-003,	-9.996972e-001,	0.000000e+000,	0.000000e+000,
-2.519957e-002,	4.670000e+002,	4.680000e+002,	-1.715420e-002,	1.715420e-002,
-4.124135e-003,	-9.996972e-001,	0.000000e+000,	0.000000e+000,	3.606108e-003,
4.690000e+002,	4.700000e+002,	-1.715420e-002,	1.715420e-002,	-4.124135e-003,
-9.996972e-001,	-0.000000e+000,	-0.000000e+000,	-1.076792e-002,	-1.401000e+003,
-8.630000e+002,	1.715420e-002,	-1.715420e-002,	4.124135e-003,	9.996972e-001,
-0.000000e+000,	-0.000000e+000,	1.078233e-002,	4.710000e+002,	4.720000e+002,
5.627065e-001,	5.627065e-001,	-1.352833e-001,	-0.000000e+000,	5.902722e-001,
-0.000000e+000,	-5.691086e-001,	4.730000e+002,	4.740000e+002,	-1.715420e-002,
1.715420e-002,	-4.124135e-003,	0.000000e+000,	0.000000e+000,	-9.996972e-001,
3.606108e-003,	4.750000e+002,	4.760000e+002,	-1.714620e-002,	-3.429240e-002,
8.244421e-003,	9.992307e-001,	-0.000000e+000,	-0.000000e+000,	2.156899e-002,
4.770000e+002,	4.780000e+002,	-1.714620e-002,	-3.429240e-002,	8.244421e-003,
9.992307e-001,	-0.000000e+000,	-0.000000e+000,	2.155459e-002,	-5.520000e+002,
-1.000000e+000,	-1.714620e-002,	-3.429240e-002,	8.244421e-003,	9.992307e-001,
-0.000000e+000,	-0.000000e+000,	2.159778e-002,	4.790000e+002,	4.800000e+002,
-1.714620e-002,	-3.429240e-002,	8.244421e-003,	9.992307e-001,	-0.000000e+000,
-0.000000e+000,	2.161218e-002,	-5.520000e+002,	-1.000000e+000,	-7.071068e-001,
0.000000e+000,	0.000000e+000,	0.000000e+000,	7.071068e-001,	0.000000e+000,
0.000000e+000,	4.810000e+002,	4.820000e+002,	-1.714620e-002,	-3.429240e-002,
8.244421e-003,	0.000000e+000,	0.000000e+000,	9.992307e-001,	-7.208850e-003,
4.830000e+002,	4.840000e+002,	6.900039e-001,	-0.000000e+000,	-0.000000e+000,
-0.000000e+000,	-7.238056e-001,	-0.000000e+000,	2.635709e-001,	4.850000e+002,
4.860000e+002,	-1.714620e-002,	-3.429240e-002,	8.244421e-003,	9.992307e-001,
0.000000e+000,	0.000000e+000,	7.187267e-003,	4.870000e+002,	4.880000e+002,
-5.478672e-001,	-5.478672e-001,	2.634314e-001,	-0.000000e+000,	-5.747060e-001,
-0.000000e+000,	2.514108e-002,	4.890000e+002,	-2.720000e+002,	1.799417e-002,
-1.799417e-002,	0.000000e+000,	0.000000e+000,	0.000000e+000,	-9.996762e-001,
0.000000e+000,	4.900000e+002,	4.910000e+002,	1.717149e-002,	-1.717149e-002,
-0.000000e+000,	-9.997046e-001,	-0.000000e+000,	-9.997046e-004,	4.323043e-003,
4.920000e+002,	4.930000e+002,	1.715435e-002,	-1.715435e-002,	-0.000000e+000,
-9.997057e-001,	-0.000000e+000,	-0.000000e+000,	4.333132e-003,	4.940000e+002,
4.950000e+002,	-5.478672e-001,	-5.478672e-001,	2.634314e-001,	-0.000000e+000,
-5.747060e-001,	-0.000000e+000,	6.658200e-002,	4.960000e+002,	4.970000e+002,
-5.773503e-001,	-5.773503e-001,	0.000000e+000,	0.000000e+000,	-5.773503e-001,
0.000000e+000,	0.000000e+000,	4.980000e+002,	4.990000e+002,	-5.773503e-001,
-5.773503e-001,	0.000000e+000,	0.000000e+000,	-5.773503e-001,	0.000000e+000,
0.000000e+000,	5.000000e+002,	5.010000e+002,	1.715435e-002,	-1.715435e-002,
0.000000e+000,	-9.997057e-001,	0.000000e+000,	0.000000e+000,	-2.448719e-002,
5.020000e+002,	5.030000e+002,	5.478672e-001,	5.478672e-001,	-2.634314e-001,
-0.000000e+000,	5.747060e-001,	-0.000000e+000,	-5.265353e-001,	-8.630000e+002,
5.040000e+002,	1.962224e-001,	1.638187e-001,	-8.655942e-002,	-9.441967e-001,
1.888393e-001,	-0.000000e+000,	-1.417258e-001,	-8.630000e+002,	5.050000e+002,
1.717149e-002,	-1.717149e-002,	-0.000000e+000,	-9.997046e-001,	-0.000000e+000,
-9.997046e-004,	4.323043e-003,	5.060000e+002,	5.070000e+002,	1.715435e-002,
-1.715435e-002,	-0.000000e+000,	-9.997057e-001,	-0.000000e+000,	-0.000000e+000,
4.333132e-003,	5.080000e+002,	5.090000e+002,	5.478672e-001,	5.478672e-001,
-2.634314e-001,	-0.000000e+000,	5.747060e-001,	-0.000000e+000,	-4.851357e-001,
5.100000e+002,	5.110000e+002,	5.478672e-001,	5.478672e-001,	-2.634314e-001,
-0.000000e+000,	5.747060e-001,	-0.000000e+000,	-5.265353e-001,	5.120000e+002,