???ˉ?÷ê??éì¨μ?????·?·¨·???ó?éè??
?aòa
±??????????ˉ?÷ê??éì¨μ??????êìa￡??????ˉ?÷ê??éì¨????μ??ù±??-àí??DDá?é?è?μ?·???￡??ùóú???ˉ1y3ì?Dμ??üá?ê?o??¨àí?￠?¨?á×a?ˉ?¨?éoíPID?????-àí?????ˉ?÷ê??éì¨μ??????êìa??DDá?·???oí?¨?￡￡?2￠à?ó?Matlab???￡Dí??DD?ó?a￡?×???ìá3?á?o?àíμ????ˉ?÷ê??éì¨????·?·¨?￡
?????êìa1￡o?ù?Y???ˉ?÷???ˉ1y3ì?Dμ??üá?ê?o??¨àí￡?í?μ?3?μèD§μ?×a?ˉ1?á?ó?1??ˉ°????￠??oéμ?1??μê?￡o ￡?2￠?ú???¨ì??t??μ?μ?μèD§×a?ˉ1?á??a ?￡
?????êìa2￡oê×?èà?ó??￠?a·¨???ù??μ?èy??·é??μ?1?á???DDá??ó?a￡?μ?èy??·é??μ??úDμ1?á?·?±e?a￡o ?￠ ?￠ ￡??ùà?ó???áD×éo?μ?·?ê?μ?μ?á??úDμ1?á??é?üμ?°???×éo?·?°??￡°?°????é?üμ?·?°?ó??ù?ü213￥μ??üá?×?o?????￡?×???μ?μ??úDμ1?á?á????éDDμ?×éo?￡??ò??213￥1?á?·?±e?a￡o ?￠ ?￡
?????êìa3￡o?ùóúμ??ˉ?úμ??y?ˉμ?á÷ó???2úéúμ??¤??3é?y±èμ?1??μ￡?à?ó????ˉ1y3ì?Dμ??¨?á×a?ˉ?¨?éoí?üá?ê?o??¨àí￡??¨á￠á?ò???òààμóú?é1?2aá?￡¨×a?ù￡?μ?êy?§?￡Dí￡o ￡?′ó??μ?μ??êìa2?Dá????éDD×éo?·?°???213￥1?á??ù??ó|μ??y?ˉμ?á÷·?±e?a￡o ?￠ ?￡
?????êìa4￡o?ù?Y?à??????·?·¨ó?áóμ???±ê￡¨?üá??ó2?￡?￡?à?ó?μèD§1?á?μ?μ??·ê?ê±???ˉ1y3ì??o?μ??üá??a52150J￡?1?óú?à??ó|μ?êμ?éì¨é??ú???ˉ1y3ì?D??o?μ??üá?￡????úDμ1?á?oí213￥1?á??ú?÷ê±????μ??üá???DDà??ó?óoí￡?×???μ?μ????¨????·?·¨??μ?êμ?êo??ü?a87346J￡?òò′???????·?·¨μ??üá??ó2??a35196J?￡óé′??é??￡????êìa?D??3?μ?????·?·¨?é?ü2￠2?íêé??￡
?????êìa5￡oà?ó??êìa3μ?3?μ??￡Dí?áo?????·?·¨ó?áóμ??à????±ê￡?μ?μ?á?ò????ùóúê±?????ú?üá???oaμ?????·?·¨￡??′°????????ˉ1y3ì??·??aè??é??ê±????￡??ú????ê±?????úà?ó??êìa3μ??￡Dí??DD?ó?a￡?×???μ?μ?ò???μ?á÷?ùóú?é1?2aá?μ??????ú????·?·¨?￡??·?·¨ó?μ??úóú?￡Dí?á11?òμ￥￡??ú????1y3ì?D?üá??úàí??é?ò??±±￡3?á??ó2?,?ù?Y???à????±ê?éò?′?μ?oüo?μ?ó???D?￡?è±μ??úóú??óD????êμ?ê?D?????üá???o?￡??ò?y?ˉμ?á÷ó?1|?ê3é1ì?¨±èày1??μ￡?è±·|áé??D?￡??é?@@?????2??￡
?????êìa6￡o??óú?ú?êìa5?D?ùéè??·?·¨μ????TD??￠2?áé??D?μèè±?Y￡?±???òy??á?PID??·¨￡??ùóúPID??·¨ó??êìa5?D?¨á￠μ?????·?·¨￡?μ?μ?á?ò???áé???ò??óDoê1?μ÷??×÷ó?μ?????·?·¨?￡

1??ü×?￡o?üá?ê?o?￡?μèD§1?á?￡?213￥1?á?￡?PID??·¨

1?￠?êìa??ê?
?aá??ì2a???ˉ?÷μ?×?o?D??ü￡?Dèòa?ú?÷??2?í??é??????DD′óá??·ê??￡μ?ê?￡?3μá?éè???×???T·¨?·ê?￡????ü?úר??μ????ˉ?÷ê??éì¨é????ùéè??μ??·ê???DD?￡?aê??é?￡?·ê?3μá?μ????¨3μ???ú???ˉê±3Dêü??oé?￡???a????oé?ú3μá????ˉê±??óDμ??üá?μèD§μ?×a?ˉ?aê??éì¨é?·é??oí?÷?áμè?ú11×a?ˉê±??óDμ??üá??￡·é??×éóéè??é??·é??×é3é￡?ê1ó?ê±?ù?YDèòa????????·é??1ì?¨μ??÷?áé?￡?óDD?1?á??T·¨íêè?ó??úDμ1?á?à′μèD§￡??ùò?òa?ú???ˉ1y3ì?D￡?è?μ??ˉ?ú?úò??¨1??éμ?μ?á÷??????2?ó?1¤×÷￡?213￥óéóú?úDμ1?á?2?×???è±éùμ??üá??￡μ??ˉ?úμ??y?ˉμ?á÷ó???2úéúμ??¤??3é?y±è?￡??Dè?D??ò????êìa￡o
1. ???¨μ￥???°??μ?1??ˉ°???ò??°???ˉê±3Dêüμ???oé￡??ó??μèD§μ?×a?ˉ1?á??￡
2. ò??aμ?3???·D?????·é??μ??úía?±???￠o??è?￠?ü?è?￠?ù′?1?á??￠?ü213￥μ??üá??àó|μ?1?á?μ?·??§￡??ê?éò?×é3é??D??úDμ1?á?￡???óú?êìa1?Dμ?μ?μ?μèD§μ?×a?ˉ1?á?￡?Dèòaó?μ??ˉ?ú213￥?à′óμ?1?á?￡?
3. ?¨á￠μ??ˉ?ú?y?ˉμ?á÷òààμóú?é1?2aá?μ?êy?§?￡Dí￡?2￠?ú?êìa1oí?êìa2μ?ì??t??￡??ùéè???ˉ???ù?è?a3￡êy￡?3?ê??ù?è?a50 km/h￡????ˉ5.0??oó3μ?ù?aá?￡??????y?ˉμ?á÷?￡
4. ??±í?D??3?á??3??????·?·¨?úì??¨ì??t??μ?μ?μ?êy?Y￡?òa?óà?ó??aD?êy?Y????·?·¨?′DDμ??á1???DD?à???￡
5. °′??μú3?êμ?3?μ?êy?§?￡Dí￡???3??ù?Y?°ò???ê±????1?2aμ?μ??2ê±×a?ùó?/?ò?2ê±?¤??￡?éè??±?ê±????μ?á÷?μμ??????ú????·?·¨￡?2￠????·?·¨??DD?à???￡
6. òà?Yμú5?ê?D????·?·¨μ??à???á1?￡???D?éè??ò?????á?íêé?μ??????ú????·?·¨2￠×÷?à???￡