更新Simulink Fir， 加入新电机的非线性校准

Signed-off-by: huhui <huhui@sharkgulf.com>

Simulink/Fir_angle4.m

@@ -0,0 +1,26 @@
+function Hd = Fir_angle3
+%FIR_ANGLE3 返回离散时间滤波器对象。
+
+% MATLAB Code
+% Generated by MATLAB(R) 9.9 and Signal Processing Toolbox 8.5.
+% Generated on: 26-Oct-2022 17:32:33
+
+% Equiripple Lowpass filter designed using the FIRPM function.
+
+% All frequency values are in Hz.
+Fs = 500;  % Sampling Frequency
+
+Fpass = 0.2;             % Passband Frequency
+Fstop = 3;               % Stopband Frequency
+Dpass = 0.057501127785;  % Passband Ripple
+Dstop = 0.0001;          % Stopband Attenuation
+dens  = 20;              % Density Factor
+
+% Calculate the order from the parameters using FIRPMORD.
+[N, Fo, Ao, W] = firpmord([Fpass, Fstop]/(Fs/2), [1 0], [Dpass, Dstop]);
+
+% Calculate the coefficients using the FIRPM function.
+b  = firpm(N, Fo, Ao, W, {dens});
+Hd = dfilt.dffir(b);
+
+% [EOF]

Simulink/angle5.csv

@@ -0,0 +1,3072 @@
+1150 
+1083 
+1092 
+1077 
+1053 
+986 
+937 
+930 
+989 
+1007 
+1057 
+1033 
+1025 
+935 
+910 
+886 
+887 
+838 
+814 
+830 
+848 
+799 
+834 
+892 
+968 
+1019 
+1086 
+1137 
+1196 
+1247 
+1323 
+1374 
+1425 
+1425 
+1426 
+1435 
+1428 
+1369 
+1329 
+1313 
+1331 
+1307 
+1282 
+1308 
+1325 
+1360 
+1376 
+1361 
+1337 
+1313 
+1330 
+1314 
+1315 
+1332 
+1308 
+1342 
+1326 
+1310 
+1320 
+1329 
+1321 
+1347 
+1348 
+1415 
+1416 
+1441 
+1476 
+1477 
+1453 
+1428 
+1412 
+1446 
+1439 
+1448 
+1415 
+1383 
+1359 
+1351 
+1360 
+1436 
+1470 
+1488 
+1555 
+1539 
+1540 
+1499 
+1467 
+1492 
+1451 
+1385 
+1328 
+1346 
+1287 
+1272 
+1306 
+1315 
+1366 
+1350 
+1409 
+1402 
+1336 
+1311 
+1229 
+1246 
+1181 
+1107 
+1115 
+1108 
+1034 
+1060 
+1051 
+1111 
+1153 
+1163 
+1230 
+1264 
+1206 
+1216 
+1192 
+1167 
+1159 
+1135 
+1086 
+1071 
+1046 
+1022 
+1056 
+1074 
+1125 
+1141 
+1201 
+1277 
+1261 
+1278 
+1304 
+1280 
+1256 
+1215 
+1207 
+1183 
+1167 
+1135 
+1118 
+1127 
+1145 
+1138 
+1197 
+1205 
+1265 
+1207 
+1217 
+1175 
+1168 
+1152 
+1170 
+1162 
+1162 
+1147 
+1148 
+1199 
+1225 
+1216 
+1276 
+1285 
+1328 
+1328 
+1379 
+1421 
+1456 
+1457 
+1482 
+1491 
+1500 
+1526 
+1493 
+1511 
+1503 
+1463 
+1439 
+1439 
+1415 
+1441 
+1442 
+1458 
+1493 
+1419 
+1403 
+1354 
+1304 
+1322 
+1248 
+1224 
+1200 
+1200 
+1201 
+1277 
+1311 
+1353 
+1395 
+1455 
+1514 
+1582 
+1615 
+1683 
+1700 
+1710 
+1660 
+1686 
+1678 
+1629 
+1564 
+1539 
+1515 
+1482 
+1417 
+1408 
+1468 
+1535 
+1520 
+1521 
+1487 
+1488 
+1439 
+1415 
+1425 
+1400 
+1359 
+1352 
+1336 
+1319 
+1295 
+1355 
+1431 
+1457 
+1482 
+1549 
+1584 
+1610 
+1601 
+1561 
+1587 
+1563 
+1489 
+1464 
+1440 
+1416 
+1342 
+1367 
+1409 
+1460 
+1470 
+1471 
+1546 
+1563 
+1456 
+1474 
+1500 
+1475 
+1451 
+1477 
+1503 
+1453 
+1362 
+1380 
+1356 
+1365 
+1307 
+1258 
+1292 
+1276 
+1193 
+1186 
+1212 
+1188 
+1114 
+1139 
+1165 
+1141 
+1075 
+1042 
+1068 
+1077 
+1095 
+1121 
+1171 
+1247 
+1189 
+1207 
+1208 
+1200 
+1126 
+1093 
+1078 
+1053 
+962 
+955 
+1031 
+1015 
+1032 
+1058 
+1100 
+1151 
+1126 
+1144 
+1187 
+1163 
+1089 
+1055 
+1081 
+1041 
+942 
+967 
+951 
+927 
+895 
+904 
+954 
+1022 
+998 
+999 
+975 
+958 
+868 
+877 
+878 
+878 
+771 
+822 
+831 
+832 
+857 
+925 
+1000 
+1035 
+1060 
+1136 
+1212 
+1254 
+1255 
+1280 
+1315 
+1324 
+1267 
+1258 
+1243 
+1194 
+1170 
+1137 
+1121 
+1138 
+1123 
+1149 
+1183 
+1150 
+1084 
+1043 
+1028 
+1003 
+979 
+955 
+1014 
+1023 
+999 
+1058 
+1084 
+1110 
+1135 
+1161 
+1237 
+1288 
+1289 
+1330 
+1340 
+1382 
+1342 
+1350 
+1384 
+1369 
+1345 
+1371 
+1354 
+1355 
+1298 
+1274 
+1258 
+1283 
+1301 
+1310 
+1353 
+1294 
+1287 
+1280 
+1256 
+1182 
+1140 
+1108 
+1084 
+1051 
+1060 
+1052 
+1112 
+1138 
+1180 
+1214 
+1265 
+1266 
+1267 
+1292 
+1243 
+1194 
+1170 
+1104 
+1071 
+1047 
+1006 
+982 
+925 
+958 
+984 
+1052 
+1078 
+1094 
+1104 
+1038 
+1047 
+1007 
+1015 
+958 
+959 
+860 
+860 
+861 
+804 
+855 
+864 
+914 
+898 
+907 
+892 
+884 
+884 
+786 
+720 
+721 
+679 
+655 
+598 
+624 
+650 
+625 
+684 
+727 
+753 
+728 
+754 
+730 
+714 
+724 
+707 
+716 
+734 
+685 
+660 
+711 
+662 
+630 
+656 
+647 
+715 
+683 
+667 
+709 
+701 
+644 
+670 
+663 
+663 
+639 
+648 
+649 
+625 
+558 
+559 
+594 
+628 
+611 
+679 
+688 
+681 
+607 
+582 
+591 
+584 
+510 
+477 
+486 
+470 
+463 
+506 
+564 
+615 
+616 
+692 
+767 
+843 
+869 
+936 
+962 
+954 
+897 
+923 
+932 
+858 
+825 
+801 
+844 
+803 
+678 
+662 
+730 
+797 
+782 
+757 
+783 
+701 
+635 
+618 
+636 
+629 
+538 
+531 
+589 
+615 
+599 
+642 
+700 
+776 
+844 
+920 
+996 
+1071 
+1047 
+1073 
+1149 
+1208 
+1150 
+1134 
+1152 
+1169 
+1053 
+1029 
+1038 
+1031 
+998 
+1032 
+1108 
+1084 
+1110 
+1076 
+1061 
+1087 
+963 
+1039 
+1064 
+1040 
+1016 
+1042 
+1108 
+1093 
+1069 
+1045 
+1121 
+1121 
+1105 
+1139 
+1182 
+1200 
+1175 
+1117 
+1168 
+1203 
+1111 
+1154 
+1180 
+1189 
+1082 
+1107 
+1099 
+1109 
+1085 
+1160 
+1236 
+1270 
+1246 
+1247 
+1280 
+1256 
+1166 
+1117 
+1142 
+1118 
+1002 
+1011 
+1029 
+1004 
+997 
+1031 
+1099 
+1125 
+1066 
+1076 
+1018 
+994 
+903 
+829 
+855 
+831 
+807 
+724 
+725 
+742 
+760 
+826 
+877 
+887 
+913 
+914 
+922 
+915 
+874 
+842 
+850 
+843 
+769 
+745 
+721 
+746 
+772 
+798 
+874 
+916 
+925 
+1001 
+1018 
+1003 
+978 
+987 
+955 
+914 
+899 
+907 
+883 
+834 
+827 
+810 
+877 
+878 
+938 
+989 
+989 
+931 
+849 
+867 
+859 
+868 
+852 
+862 
+846 
+838 
+864 
+923 
+916 
+975 
+1008 
+1059 
+1069 
+1078 
+1153 
+1145 
+1171 
+1156 
+1207 
+1232 
+1208 
+1184 
+1210 
+1201 
+1177 
+1128 
+1113 
+1089 
+1097 
+1090 
+1166 
+1133 
+1100 
+1076 
+1069 
+1045 
+1004 
+937 
+955 
+923 
+907 
+908 
+950 
+1001 
+1027 
+1094 
+1178 
+1220 
+1238 
+1306 
+1382 
+1415 
+1399 
+1409 
+1418 
+1410 
+1336 
+1312 
+1288 
+1297 
+1197 
+1123 
+1149 
+1217 
+1192 
+1268 
+1260 
+1270 
+1171 
+1146 
+1180 
+1173 
+1099 
+1116 
+1091 
+1076 
+1027 
+1078 
+1103 
+1120 
+1155 
+1206 
+1240 
+1282 
+1358 
+1342 
+1360 
+1385 
+1286 
+1253 
+1229 
+1214 
+1172 
+1140 
+1166 
+1142 
+1150 
+1168 
+1219 
+1245 
+1254 
+1246 
+1222 
+1239 
+1257 
+1250 
+1225 
+1209 
+1210 
+1153 
+1136 
+1154 
+1138 
+1156 
+1132 
+1132 
+1116 
+1084 
+1035 
+1018 
+1036 
+995 
+971 
+997 
+989 
+965 
+941 
+958 
+942 
+934 
+944 
+1020 
+1079 
+1071 
+1097 
+1081 
+1065 
+1050 
+975 
+976 
+910 
+878 
+853 
+871 
+855 
+856 
+857 
+932 
+966 
+992 
+1010 
+1051 
+1036 
+987 
+988 
+939 
+914 
+873 
+866 
+842 
+842 
+743 
+752 
+795 
+846 
+846 
+888 
+906 
+874 
+808 
+792 
+834 
+777 
+736 
+745 
+712 
+705 
+714 
+782 
+782 
+841 
+909 
+976 
+1051 
+1127 
+1153 
+1171 
+1214 
+1239 
+1215 
+1191 
+1208 
+1167 
+1184 
+1135 
+1145 
+1046 
+1037 
+1047 
+1073 
+1099 
+1125 
+1150 
+1067 
+1035 
+953 
+936 
+929 
+905 
+931 
+924 
+965 
+1008 
+1017 
+1060 
+1085 
+1127 
+1162 
+1196 
+1230 
+1264 
+1290 
+1316 
+1342 
+1325 
+1376 
+1360 
+1345 
+1337 
+1346 
+1313 
+1298 
+1274 
+1291 
+1233 
+1276 
+1277 
+1311 
+1278 
+1237 
+1246 
+1222 
+1182 
+1140 
+1083 
+1100 
+1085 
+1060 
+1036 
+1112 
+1138 
+1197 
+1214 
+1265 
+1316 
+1300 
+1292 
+1284 
+1244 
+1211 
+1146 
+1146 
+1105 
+1064 
+1049 
+1041 
+1025 
+1059 
+1052 
+1136 
+1186 
+1129 
+1155 
+1097 
+1107 
+1040 
+1024 
+1017 
+910 
+935 
+878 
+895 
+905 
+897 
+914 
+990 
+1041 
+959 
+942 
+934 
+894 
+837 
+796 
+846 
+772 
+731 
+682 
+741 
+725 
+726 
+777 
+853 
+836 
+821 
+830 
+856 
+865 
+840 
+833 
+809 
+827 
+752 
+778 
+779 
+788 
+764 
+764 
+815 
+799 
+792 
+842 
+868 
+844 
+845 
+846 
+888 
+897 
+873 
+849 
+875 
+850 
+826 
+852 
+861 
+853 
+846 
+880 
+881 
+907 
+865 
+816 
+784 
+760 
+727 
+736 
+745 
+763 
+722 
+739 
+790 
+816 
+875 
+917 
+1001 
+1044 
+1095 
+1121 
+1196 
+1222 
+1173 
+1124 
+1150 
+1083 
+1092 
+1077 
+1053 
+986 
+937 
+930 
+989 
+1007 
+1057 
+1033 
+1025 
+935 
+910 
+886 
+887 
+838 
+814 
+830 
+848 
+799 
+834 
+892 
+968 
+1019 
+1086 
+1137 
+1196 
+1247 
+1323 
+1374 
+1425 
+1425 
+1426 
+1435 
+1428 
+1369 
+1329 
+1313 
+1331 
+1307 
+1282 
+1308 
+1325 
+1360 
+1376 
+1361 
+1337 
+1313 
+1330 
+1314 
+1315 
+1332 
+1308 
+1342 
+1326 
+1310 
+1320 
+1329 
+1321 
+1347 
+1348 
+1415 
+1416 
+1441 
+1476 
+1477 
+1453 
+1428 
+1412 
+1446 
+1439 
+1448 
+1415 
+1383 
+1359 
+1351 
+1360 
+1436 
+1470 
+1488 
+1555 
+1539 
+1540 
+1499 
+1467 
+1492 
+1451 
+1385 
+1328 
+1346 
+1287 
+1272 
+1306 
+1315 
+1366 
+1350 
+1409 
+1402 
+1336 
+1311 
+1229 
+1246 
+1181 
+1107 
+1115 
+1108 
+1034 
+1060 
+1051 
+1111 
+1153 
+1163 
+1230 
+1264 
+1206 
+1216 
+1192 
+1167 
+1159 
+1135 
+1086 
+1071 
+1046 
+1022 
+1056 
+1074 
+1125 
+1141 
+1201 
+1277 
+1261 
+1278 
+1304 
+1280 
+1256 
+1215 
+1207 
+1183 
+1167 
+1135 
+1118 
+1127 
+1145 
+1138 
+1197 
+1205 
+1265 
+1207 
+1217 
+1175 
+1168 
+1152 
+1170 
+1162 
+1162 
+1147 
+1148 
+1199 
+1225 
+1216 
+1276 
+1285 
+1328 
+1328 
+1379 
+1421 
+1456 
+1457 
+1482 
+1491 
+1500 
+1526 
+1493 
+1511 
+1503 
+1463 
+1439 
+1439 
+1415 
+1441 
+1442 
+1458 
+1493 
+1419 
+1403 
+1354 
+1304 
+1322 
+1248 
+1224 
+1200 
+1200 
+1201 
+1277 
+1311 
+1353 
+1395 
+1455 
+1514 
+1582 
+1615 
+1683 
+1700 
+1710 
+1660 
+1686 
+1678 
+1629 
+1564 
+1539 
+1515 
+1482 
+1417 
+1408 
+1468 
+1535 
+1520 
+1521 
+1487 
+1488 
+1439 
+1415 
+1425 
+1400 
+1359 
+1352 
+1336 
+1319 
+1295 
+1355 
+1431 
+1457 
+1482 
+1549 
+1584 
+1610 
+1601 
+1561 
+1587 
+1563 
+1489 
+1464 
+1440 
+1416 
+1342 
+1367 
+1409 
+1460 
+1470 
+1471 
+1546 
+1563 
+1456 
+1474 
+1500 
+1475 
+1451 
+1477 
+1503 
+1453 
+1362 
+1380 
+1356 
+1365 
+1307 
+1258 
+1292 
+1276 
+1193 
+1186 
+1212 
+1188 
+1114 
+1139 
+1165 
+1141 
+1075 
+1042 
+1068 
+1077 
+1095 
+1121 
+1171 
+1247 
+1189 
+1207 
+1208 
+1200 
+1126 
+1093 
+1078 
+1053 
+962 
+955 
+1031 
+1015 
+1032 
+1058 
+1100 
+1151 
+1126 
+1144 
+1187 
+1163 
+1089 
+1055 
+1081 
+1041 
+942 
+967 
+951 
+927 
+895 
+904 
+954 
+1022 
+998 
+999 
+975 
+958 
+868 
+877 
+878 
+878 
+771 
+822 
+831 
+832 
+857 
+925 
+1000 
+1035 
+1060 
+1136 
+1212 
+1254 
+1255 
+1280 
+1315 
+1324 
+1267 
+1258 
+1243 
+1194 
+1170 
+1137 
+1121 
+1138 
+1123 
+1149 
+1183 
+1150 
+1084 
+1043 
+1028 
+1003 
+979 
+955 
+1014 
+1023 
+999 
+1058 
+1084 
+1110 
+1135 
+1161 
+1237 
+1288 
+1289 
+1330 
+1340 
+1382 
+1342 
+1350 
+1384 
+1369 
+1345 
+1371 
+1354 
+1355 
+1298 
+1274 
+1258 
+1283 
+1301 
+1310 
+1353 
+1294 
+1287 
+1280 
+1256 
+1182 
+1140 
+1108 
+1084 
+1051 
+1060 
+1052 
+1112 
+1138 
+1180 
+1214 
+1265 
+1266 
+1267 
+1292 
+1243 
+1194 
+1170 
+1104 
+1071 
+1047 
+1006 
+982 
+925 
+958 
+984 
+1052 
+1078 
+1094 
+1104 
+1038 
+1047 
+1007 
+1015 
+958 
+959 
+860 
+860 
+861 
+804 
+855 
+864 
+914 
+898 
+907 
+892 
+884 
+884 
+786 
+720 
+721 
+679 
+655 
+598 
+624 
+650 
+625 
+684 
+727 
+753 
+728 
+754 
+730 
+714 
+724 
+707 
+716 
+734 
+685 
+660 
+711 
+662 
+630 
+656 
+647 
+715 
+683 
+667 
+709 
+701 
+644 
+670 
+663 
+663 
+639 
+648 
+649 
+625 
+558 
+559 
+594 
+628 
+611 
+679 
+688 
+681 
+607 
+582 
+591 
+584 
+510 
+477 
+486 
+470 
+463 
+506 
+564 
+615 
+616 
+692 
+767 
+843 
+869 
+936 
+962 
+954 
+897 
+923 
+932 
+858 
+825 
+801 
+844 
+803 
+678 
+662 
+730 
+797 
+782 
+757 
+783 
+701 
+635 
+618 
+636 
+629 
+538 
+531 
+589 
+615 
+599 
+642 
+700 
+776 
+844 
+920 
+996 
+1071 
+1047 
+1073 
+1149 
+1208 
+1150 
+1134 
+1152 
+1169 
+1053 
+1029 
+1038 
+1031 
+998 
+1032 
+1108 
+1084 
+1110 
+1076 
+1061 
+1087 
+963 
+1039 
+1064 
+1040 
+1016 
+1042 
+1108 
+1093 
+1069 
+1045 
+1121 
+1121 
+1105 
+1139 
+1182 
+1200 
+1175 
+1117 
+1168 
+1203 
+1111 
+1154 
+1180 
+1189 
+1082 
+1107 
+1099 
+1109 
+1085 
+1160 
+1236 
+1270 
+1246 
+1247 
+1280 
+1256 
+1166 
+1117 
+1142 
+1118 
+1002 
+1011 
+1029 
+1004 
+997 
+1031 
+1099 
+1125 
+1066 
+1076 
+1018 
+994 
+903 
+829 
+855 
+831 
+807 
+724 
+725 
+742 
+760 
+826 
+877 
+887 
+913 
+914 
+922 
+915 
+874 
+842 
+850 
+843 
+769 
+745 
+721 
+746 
+772 
+798 
+874 
+916 
+925 
+1001 
+1018 
+1003 
+978 
+987 
+955 
+914 
+899 
+907 
+883 
+834 
+827 
+810 
+877 
+878 
+938 
+989 
+989 
+931 
+849 
+867 
+859 
+868 
+852 
+862 
+846 
+838 
+864 
+923 
+916 
+975 
+1008 
+1059 
+1069 
+1078 
+1153 
+1145 
+1171 
+1156 
+1207 
+1232 
+1208 
+1184 
+1210 
+1201 
+1177 
+1128 
+1113 
+1089 
+1097 
+1090 
+1166 
+1133 
+1100 
+1076 
+1069 
+1045 
+1004 
+937 
+955 
+923 
+907 
+908 
+950 
+1001 
+1027 
+1094 
+1178 
+1220 
+1238 
+1306 
+1382 
+1415 
+1399 
+1409 
+1418 
+1410 
+1336 
+1312 
+1288 
+1297 
+1197 
+1123 
+1149 
+1217 
+1192 
+1268 
+1260 
+1270 
+1171 
+1146 
+1180 
+1173 
+1099 
+1116 
+1091 
+1076 
+1027 
+1078 
+1103 
+1120 
+1155 
+1206 
+1240 
+1282 
+1358 
+1342 
+1360 
+1385 
+1286 
+1253 
+1229 
+1214 
+1172 
+1140 
+1166 
+1142 
+1150 
+1168 
+1219 
+1245 
+1254 
+1246 
+1222 
+1239 
+1257 
+1250 
+1225 
+1209 
+1210 
+1153 
+1136 
+1154 
+1138 
+1156 
+1132 
+1132 
+1116 
+1084 
+1035 
+1018 
+1036 
+995 
+971 
+997 
+989 
+965 
+941 
+958 
+942 
+934 
+944 
+1020 
+1079 
+1071 
+1097 
+1081 
+1065 
+1050 
+975 
+976 
+910 
+878 
+853 
+871 
+855 
+856 
+857 
+932 
+966 
+992 
+1010 
+1051 
+1036 
+987 
+988 
+939 
+914 
+873 
+866 
+842 
+842 
+743 
+752 
+795 
+846 
+846 
+888 
+906 
+874 
+808 
+792 
+834 
+777 
+736 
+745 
+712 
+705 
+714 
+782 
+782 
+841 
+909 
+976 
+1051 
+1127 
+1153 
+1171 
+1214 
+1239 
+1215 
+1191 
+1208 
+1167 
+1184 
+1135 
+1145 
+1046 
+1037 
+1047 
+1073 
+1099 
+1125 
+1150 
+1067 
+1035 
+953 
+936 
+929 
+905 
+931 
+924 
+965 
+1008 
+1017 
+1060 
+1085 
+1127 
+1162 
+1196 
+1230 
+1264 
+1290 
+1316 
+1342 
+1325 
+1376 
+1360 
+1345 
+1337 
+1346 
+1313 
+1298 
+1274 
+1291 
+1233 
+1276 
+1277 
+1311 
+1278 
+1237 
+1246 
+1222 
+1182 
+1140 
+1083 
+1100 
+1085 
+1060 
+1036 
+1112 
+1138 
+1197 
+1214 
+1265 
+1316 
+1300 
+1292 
+1284 
+1244 
+1211 
+1146 
+1146 
+1105 
+1064 
+1049 
+1041 
+1025 
+1059 
+1052 
+1136 
+1186 
+1129 
+1155 
+1097 
+1107 
+1040 
+1024 
+1017 
+910 
+935 
+878 
+895 
+905 
+897 
+914 
+990 
+1041 
+959 
+942 
+934 
+894 
+837 
+796 
+846 
+772 
+731 
+682 
+741 
+725 
+726 
+777 
+853 
+836 
+821 
+830 
+856 
+865 
+840 
+833 
+809 
+827 
+752 
+778 
+779 
+788 
+764 
+764 
+815 
+799 
+792 
+842 
+868 
+844 
+845 
+846 
+888 
+897 
+873 
+849 
+875 
+850 
+826 
+852 
+861 
+853 
+846 
+880 
+881 
+907 
+865 
+816 
+784 
+760 
+727 
+736 
+745 
+763 
+722 
+739 
+790 
+816 
+875 
+917 
+1001 
+1044 
+1095 
+1121 
+1196 
+1222 
+1173 
+1124 
+1150 
+1083 
+1092 
+1077 
+1053 
+986 
+937 
+930 
+989 
+1007 
+1057 
+1033 
+1025 
+935 
+910 
+886 
+887 
+838 
+814 
+830 
+848 
+799 
+834 
+892 
+968 
+1019 
+1086 
+1137 
+1196 
+1247 
+1323 
+1374 
+1425 
+1425 
+1426 
+1435 
+1428 
+1369 
+1329 
+1313 
+1331 
+1307 
+1282 
+1308 
+1325 
+1360 
+1376 
+1361 
+1337 
+1313 
+1330 
+1314 
+1315 
+1332 
+1308 
+1342 
+1326 
+1310 
+1320 
+1329 
+1321 
+1347 
+1348 
+1415 
+1416 
+1441 
+1476 
+1477 
+1453 
+1428 
+1412 
+1446 
+1439 
+1448 
+1415 
+1383 
+1359 
+1351 
+1360 
+1436 
+1470 
+1488 
+1555 
+1539 
+1540 
+1499 
+1467 
+1492 
+1451 
+1385 
+1328 
+1346 
+1287 
+1272 
+1306 
+1315 
+1366 
+1350 
+1409 
+1402 
+1336 
+1311 
+1229 
+1246 
+1181 
+1107 
+1115 
+1108 
+1034 
+1060 
+1051 
+1111 
+1153 
+1163 
+1230 
+1264 
+1206 
+1216 
+1192 
+1167 
+1159 
+1135 
+1086 
+1071 
+1046 
+1022 
+1056 
+1074 
+1125 
+1141 
+1201 
+1277 
+1261 
+1278 
+1304 
+1280 
+1256 
+1215 
+1207 
+1183 
+1167 
+1135 
+1118 
+1127 
+1145 
+1138 
+1197 
+1205 
+1265 
+1207 
+1217 
+1175 
+1168 
+1152 
+1170 
+1162 
+1162 
+1147 
+1148 
+1199 
+1225 
+1216 
+1276 
+1285 
+1328 
+1328 
+1379 
+1421 
+1456 
+1457 
+1482 
+1491 
+1500 
+1526 
+1493 
+1511 
+1503 
+1463 
+1439 
+1439 
+1415 
+1441 
+1442 
+1458 
+1493 
+1419 
+1403 
+1354 
+1304 
+1322 
+1248 
+1224 
+1200 
+1200 
+1201 
+1277 
+1311 
+1353 
+1395 
+1455 
+1514 
+1582 
+1615 
+1683 
+1700 
+1710 
+1660 
+1686 
+1678 
+1629 
+1564 
+1539 
+1515 
+1482 
+1417 
+1408 
+1468 
+1535 
+1520 
+1521 
+1487 
+1488 
+1439 
+1415 
+1425 
+1400 
+1359 
+1352 
+1336 
+1319 
+1295 
+1355 
+1431 
+1457 
+1482 
+1549 
+1584 
+1610 
+1601 
+1561 
+1587 
+1563 
+1489 
+1464 
+1440 
+1416 
+1342 
+1367 
+1409 
+1460 
+1470 
+1471 
+1546 
+1563 
+1456 
+1474 
+1500 
+1475 
+1451 
+1477 
+1503 
+1453 
+1362 
+1380 
+1356 
+1365 
+1307 
+1258 
+1292 
+1276 
+1193 
+1186 
+1212 
+1188 
+1114 
+1139 
+1165 
+1141 
+1075 
+1042 
+1068 
+1077 
+1095 
+1121 
+1171 
+1247 
+1189 
+1207 
+1208 
+1200 
+1126 
+1093 
+1078 
+1053 
+962 
+955 
+1031 
+1015 
+1032 
+1058 
+1100 
+1151 
+1126 
+1144 
+1187 
+1163 
+1089 
+1055 
+1081 
+1041 
+942 
+967 
+951 
+927 
+895 
+904 
+954 
+1022 
+998 
+999 
+975 
+958 
+868 
+877 
+878 
+878 
+771 
+822 
+831 
+832 
+857 
+925 
+1000 
+1035 
+1060 
+1136 
+1212 
+1254 
+1255 
+1280 
+1315 
+1324 
+1267 
+1258 
+1243 
+1194 
+1170 
+1137 
+1121 
+1138 
+1123 
+1149 
+1183 
+1150 
+1084 
+1043 
+1028 
+1003 
+979 
+955 
+1014 
+1023 
+999 
+1058 
+1084 
+1110 
+1135 
+1161 
+1237 
+1288 
+1289 
+1330 
+1340 
+1382 
+1342 
+1350 
+1384 
+1369 
+1345 
+1371 
+1354 
+1355 
+1298 
+1274 
+1258 
+1283 
+1301 
+1310 
+1353 
+1294 
+1287 
+1280 
+1256 
+1182 
+1140 
+1108 
+1084 
+1051 
+1060 
+1052 
+1112 
+1138 
+1180 
+1214 
+1265 
+1266 
+1267 
+1292 
+1243 
+1194 
+1170 
+1104 
+1071 
+1047 
+1006 
+982 
+925 
+958 
+984 
+1052 
+1078 
+1094 
+1104 
+1038 
+1047 
+1007 
+1015 
+958 
+959 
+860 
+860 
+861 
+804 
+855 
+864 
+914 
+898 
+907 
+892 
+884 
+884 
+786 
+720 
+721 
+679 
+655 
+598 
+624 
+650 
+625 
+684 
+727 
+753 
+728 
+754 
+730 
+714 
+724 
+707 
+716 
+734 
+685 
+660 
+711 
+662 
+630 
+656 
+647 
+715 
+683 
+667 
+709 
+701 
+644 
+670 
+663 
+663 
+639 
+648 
+649 
+625 
+558 
+559 
+594 
+628 
+611 
+679 
+688 
+681 
+607 
+582 
+591 
+584 
+510 
+477 
+486 
+470 
+463 
+506 
+564 
+615 
+616 
+692 
+767 
+843 
+869 
+936 
+962 
+954 
+897 
+923 
+932 
+858 
+825 
+801 
+844 
+803 
+678 
+662 
+730 
+797 
+782 
+757 
+783 
+701 
+635 
+618 
+636 
+629 
+538 
+531 
+589 
+615 
+599 
+642 
+700 
+776 
+844 
+920 
+996 
+1071 
+1047 
+1073 
+1149 
+1208 
+1150 
+1134 
+1152 
+1169 
+1053 
+1029 
+1038 
+1031 
+998 
+1032 
+1108 
+1084 
+1110 
+1076 
+1061 
+1087 
+963 
+1039 
+1064 
+1040 
+1016 
+1042 
+1108 
+1093 
+1069 
+1045 
+1121 
+1121 
+1105 
+1139 
+1182 
+1200 
+1175 
+1117 
+1168 
+1203 
+1111 
+1154 
+1180 
+1189 
+1082 
+1107 
+1099 
+1109 
+1085 
+1160 
+1236 
+1270 
+1246 
+1247 
+1280 
+1256 
+1166 
+1117 
+1142 
+1118 
+1002 
+1011 
+1029 
+1004 
+997 
+1031 
+1099 
+1125 
+1066 
+1076 
+1018 
+994 
+903 
+829 
+855 
+831 
+807 
+724 
+725 
+742 
+760 
+826 
+877 
+887 
+913 
+914 
+922 
+915 
+874 
+842 
+850 
+843 
+769 
+745 
+721 
+746 
+772 
+798 
+874 
+916 
+925 
+1001 
+1018 
+1003 
+978 
+987 
+955 
+914 
+899 
+907 
+883 
+834 
+827 
+810 
+877 
+878 
+938 
+989 
+989 
+931 
+849 
+867 
+859 
+868 
+852 
+862 
+846 
+838 
+864 
+923 
+916 
+975 
+1008 
+1059 
+1069 
+1078 
+1153 
+1145 
+1171 
+1156 
+1207 
+1232 
+1208 
+1184 
+1210 
+1201 
+1177 
+1128 
+1113 
+1089 
+1097 
+1090 
+1166 
+1133 
+1100 
+1076 
+1069 
+1045 
+1004 
+937 
+955 
+923 
+907 
+908 
+950 
+1001 
+1027 
+1094 
+1178 
+1220 
+1238 
+1306 
+1382 
+1415 
+1399 
+1409 
+1418 
+1410 
+1336 
+1312 
+1288 
+1297 
+1197 
+1123 
+1149 
+1217 
+1192 
+1268 
+1260 
+1270 
+1171 
+1146 
+1180 
+1173 
+1099 
+1116 
+1091 
+1076 
+1027 
+1078 
+1103 
+1120 
+1155 
+1206 
+1240 
+1282 
+1358 
+1342 
+1360 
+1385 
+1286 
+1253 
+1229 
+1214 
+1172 
+1140 
+1166 
+1142 
+1150 
+1168 
+1219 
+1245 
+1254 
+1246 
+1222 
+1239 
+1257 
+1250 
+1225 
+1209 
+1210 
+1153 
+1136 
+1154 
+1138 
+1156 
+1132 
+1132 
+1116 
+1084 
+1035 
+1018 
+1036 
+995 
+971 
+997 
+989 
+965 
+941 
+958 
+942 
+934 
+944 
+1020 
+1079 
+1071 
+1097 
+1081 
+1065 
+1050 
+975 
+976 
+910 
+878 
+853 
+871 
+855 
+856 
+857 
+932 
+966 
+992 
+1010 
+1051 
+1036 
+987 
+988 
+939 
+914 
+873 
+866 
+842 
+842 
+743 
+752 
+795 
+846 
+846 
+888 
+906 
+874 
+808 
+792 
+834 
+777 
+736 
+745 
+712 
+705 
+714 
+782 
+782 
+841 
+909 
+976 
+1051 
+1127 
+1153 
+1171 
+1214 
+1239 
+1215 
+1191 
+1208 
+1167 
+1184 
+1135 
+1145 
+1046 
+1037 
+1047 
+1073 
+1099 
+1125 
+1150 
+1067 
+1035 
+953 
+936 
+929 
+905 
+931 
+924 
+965 
+1008 
+1017 
+1060 
+1085 
+1127 
+1162 
+1196 
+1230 
+1264 
+1290 
+1316 
+1342 
+1325 
+1376 
+1360 
+1345 
+1337 
+1346 
+1313 
+1298 
+1274 
+1291 
+1233 
+1276 
+1277 
+1311 
+1278 
+1237 
+1246 
+1222 
+1182 
+1140 
+1083 
+1100 
+1085 
+1060 
+1036 
+1112 
+1138 
+1197 
+1214 
+1265 
+1316 
+1300 
+1292 
+1284 
+1244 
+1211 
+1146 
+1146 
+1105 
+1064 
+1049 
+1041 
+1025 
+1059 
+1052 
+1136 
+1186 
+1129 
+1155 
+1097 
+1107 
+1040 
+1024 
+1017 
+910 
+935 
+878 
+895 
+905 
+897 
+914 
+990 
+1041 
+959 
+942 
+934 
+894 
+837 
+796 
+846 
+772 
+731 
+682 
+741 
+725 
+726 
+777 
+853 
+836 
+821 
+830 
+856 
+865 
+840 
+833 
+809 
+827 
+752 
+778 
+779 
+788 
+764 
+764 
+815 
+799 
+792 
+842 
+868 
+844 
+845 
+846 
+888 
+897 
+873 
+849 
+875 
+850 
+826 
+852 
+861 
+853 
+846 
+880 
+881 
+907 
+865 
+816 
+784 
+760 
+727 
+736 
+745 
+763 
+722 
+739 
+790 
+816 
+875 
+917 
+1001 
+1044 
+1095 
+1121 
+1196 
+1222 
+1173 
+1124 

Simulink/myfilter2.m

@@ -1,5 +1,5 @@
 Fir=Fir_angle2;
-in=csvread('angle4.csv');
+in=csvread('angle5.csv');
 in=in';
 angle_off=filter(Fir.Numerator, 1, in);
 out=single(angle_off);

Simulink/myfilter3.m

@@ -1,5 +1,5 @@
 Fir=Fir_angle3;
-in=csvread('angle3.csv');
+in=csvread('angle5.csv');
 in=in';
 angle_off=filter(Fir.Numerator, 1, in);
 out=single(angle_off);