[鎽� 瑕乚锛氫粙绱逛簡鍒╃敤鏁�(sh霉)瀛椾俊铏�(h脿o)铏曠悊鍣紙DSP锛夊皪(du矛)濂楄壊鍗板埛绯荤当(t菕ng)涓嫉鍔涢€�(j矛n)琛屾帶鍒剁殑鏂规硶锛岃┏绱�(x矛)闂¤堪浜嗙郴绲�(t菕ng)鐨勭‖浠剁祼(ji茅)妲�(g貌u)鍜岃粺浠惰ō(sh猫)瑷�(j矛)锛屽湪鎺у埗绛栫暐涓婇噰鐢ㄥ閲忓紡PID鎺у埗鏂规硶銆傚(sh铆)椹�(y脿n)琛ㄦ槑锛屽埄鐢―SP瑷�(sh猫)瑷�(j矛)鐨勭‖浠剁郴绲�(t菕ng)姣旇純鎴愬姛锛岄€氶亷(gu貌)DSP鑷付鐨凱WM杓稿嚭鑳藉緢鏂逛究鍦板(sh铆)鐝�(xi脿n)鎭掑嫉鍔涙帶鍒剁殑鐩殑锛屾亽寮靛姏鎺у埗鐨勮宸寖鍦嶅湪1%浠�?x煤n)?n猫i)锛屽彇寰椾簡寰堝ソ鐨勬帶鍒舵晥鏋溿€� 1 寮曡█ 寮靛姏鎺у埗琚唬娉涙噳(y墨ng)鐢ㄤ簬绱＄箶銆佸嵃鍒�銆侀嫾閻电瓑琛屾キ(y猫)锛屽嫉鍔涙帶鍒剁殑濂藉鐩存帴褰遍熆鍒扮敘(ch菐n)鍝佺殑璩�(zh矛)閲忋€傚湪鍗板埛琛屾キ(y猫)锛屽嵎鏉愰€ｇ簩(x霉)灞曢枊(k膩i)骞舵簮婧愪笉鏂峰湴閫�(j矛n)鍏ュ嵃鍒疯缃紝鍙湁浣块€�(j矛n)鍏ュ嵃鍒峰柈鍏冪殑鍗锋潗淇濇寔涓€瀹氱殑绌�(w臎n)瀹氬嫉鍔�锛屾墠鑳戒繚璀夊鍗伴亷(gu貌)绋嬬殑绌�(w臎n)瀹氬拰鍗板搧鐨勫鍗版簴(zh菙n)绮惧害銆傛墍浠�锛屽嫉鍔涙帶鍒舵槸鍗板埛鎺у埗閬�(gu貌)绋嬩腑鐨勯棞(gu膩n)閸靛洜绱�銆傛湰鏂囨彁鍑轰簡涓€绋熀浜嶥SP鐨勬亽寮靛姏鎺у埗纭欢绯荤当(t菕ng)锛屽湪寮靛姏鎺у埗鐨勬噳(y墨ng)鐢ㄤ腑鍙栧緱浜嗘瘮杓冨ソ鐨勬晥鏋�銆� 2 寮靛姏鎺у埗绛栫暐 鍦ㄦā鎿帶鍒剁郴绲�(t菕ng)涓�锛屾帶鍒跺櫒鏈€甯哥敤鐨勬帶鍒惰(gu墨)寰嬫槸PID鎺у埗銆傛枃涓帶鍒跺櫒閲囩敤澧為噺寮廝ID鎺у埗[1]銆傛帶鍒剁郴绲�(t菕ng)鍘熺悊妗嗗湒濡傚湒1鎵€绀�銆� 鎺у埗瑕�(gu墨)寰嬬偤 3 绯荤当(t菕ng)鐨勭‖浠惰ō(sh猫)瑷�(j矛) TMS320LF240绯诲垪DSP鐨勯珨绯荤祼(ji茅)妲�(g貌u)灏�(zhu膩n)鐐哄(sh铆)鏅�(sh铆)淇¤櫉(h脿o)铏曠悊鑰岃ō(sh猫)瑷�(j矛)锛岃┎绯诲垪DSP鎺у埗鍣ㄥ皣瀵�(sh铆)鏅�(sh铆)铏曠悊鑳藉姏鍜屾帶鍒跺櫒澶栬ō(sh猫)鍔熻兘闆嗕簬涓€韬�锛屽収(n猫i)閮ㄥ惈鏈夊ぇ閲忚睈瀵岀殑纭欢璩囨簮锛屼娇寰楀閮ㄥ櫒浠跺ぇ鐐烘笡灏�锛屼笉鐢ㄩ亷(gu貌)澶氬湴鑰冩叜鍣ㄤ欢鐨勬檪(sh铆)寤躲€侀倧杓棞(gu膩n)绯�銆佸櫒浠堕伕鎿囦互鍙婅垏鍏跺畠闆昏矾鐨勯厤鍚堝晱(w猫n)椤岀瓑銆� 鏈郴绲�(t菕ng)涓昏鐢卞嫉鍔涗俊铏�(h脿o)閲囬泦闆昏矾妯″銆佺绮夊埗鍕�(d貌ng)鍣ㄩ﹨(q奴)鍕�(d貌ng)闆昏矾妯″鍜孧AX485宸垎閫氫俊闆昏矾妯″鍜屾渶灏忕郴绲�(t菕ng)绲勬垚?锛涱姠椹筄(sh猫)瑷�(j矛)妗嗗湒濡傚湒2鎵€绀�銆� 3锛�1 寮靛姏淇¤櫉(h脿o)閲囬泦 鏈郴绲�(t菕ng)鍖呭惈4璺嫉鍔涢噰闆嗕俊铏�(h脿o)妯″锛屾瘡璺嫉鍔涗俊铏�(h脿o)閲囬泦閮ㄥ垎涓昏鐢卞樊鍕�(d貌ng)鏀惧ぇ鑺墖LM324銆乂锛廸璁婃彌鑺墖LM331鍜岃剤娌栬▓(j矛)鏁�(sh霉)鑺墖74HC393绲勬垚銆� 寮靛姏淇¤櫉(h脿o)缍�(j墨ng)寮靛姏鍌虫劅鍣ㄨ綁(zhu菐n)鎻涚偤闆诲淇¤櫉(h脿o)閫佺郸LM324锛孡M324鍖呮嫭鍏╃礆(j铆)宸嫊(d貌ng)鏀惧ぇ鍜屼竴绱�(j铆)姣旇純鏀惧ぇ锛岃几鍑虹偤0锝�10V闆诲淇¤櫉(h脿o)銆傞浕澹撲俊铏�(h脿o)缍�(j墨ng)绗竴绱�(j铆)宸嫊(d貌ng)鏀惧ぇ3鍊�锛岀劧鍚庡垎鍒ヨ几鍑虹郸绗簩绱�(j铆)宸嫊(d貌ng)鏀惧ぇ鍜屾瘮杓冩斁澶у櫒鐨勮几鍏ョ锛岀暥(d膩ng)?sh霉)璋濇偅?j铆)宸嫊(d貌ng)鏀惧ぇ鍚庣殑淇¤櫉(h脿o)鈮�100 mV锛屽墖缍�(j墨ng)绗簩绱�(j铆)宸嫊(d貌ng)鏀惧ぇ鍚庤几鍑�0锝�10V鐨勯浕澹�锛岀暥(d膩ng)?sh霉)璋濇偅?j铆)宸嫊(d貌ng)鏀惧ぇ鍚庣殑淇¤櫉(h脿o)>100mV锛屽墖缍�(j墨ng)姣旇純鏀惧ぇ鍚庤几鍑�10V鐨勯浕澹�銆� LM324杓稿嚭0锝�10 V鐨勯浕澹撻€佺郸LM331锛孡M331灏�0鈥�10 V闆诲淇¤櫉(h脿o)杞�(zhu菐n)鎻涚偤0锝�10kHz鐨勯牷鐜囦俊铏�(h脿o)锛岄牷鐜囦俊铏�(h脿o)缍�(j墨ng)鍏夐浕闅旈洟銆佹尝褰㈡暣褰㈠悗閫佺郸74HC393锛岄€�(j矛n)琛岃剤娌栬▓(j矛)鏁�(sh霉)锛岀劧鍚庡皣鏁�(sh霉)鎿�(j霉)閫佺郸TMS320LF2407A銆� 3锛�2 PWM椹�(q奴)鍕�(d貌ng)妯″ TMS320LF2407A鑷付16璺疨WM娉㈠舰杓稿嚭鍔熻兘[2]锛岄噰妯ｄ俊铏�(h脿o)閫佸埌CPU鍚�锛岀稉(j墨ng)閬�(gu貌)铏曠悊鐢�(ch菐n)鐢熶竴瀹氬崰绌烘瘮鐨凱WM杓稿嚭锛岀稉(j墨ng)TLP251闅旈洟骞堕﹨(q奴)鍕�(d貌ng)MOSFET绠�锛岀敘(ch菐n)鐢熶竴瀹氬崰绌烘瘮鐨勯浕娴佷俊铏�(h脿o)锛岄€佺郸纾佺矇鍒跺嫊(d貌ng)鍣紝渚�(l谩i)鎺у埗鍒跺嫊(d貌ng)杞�(zhu菐n)鐭�锛屽緸鑰岄仈(d谩)鍒版亽寮靛姏鎺у埗鐨勭洰鐨�銆� 4 杌熶欢瑷�(sh猫)瑷�(j矛) 瑭叉帶鍒剁郴绲�(t菕ng)鐨勮粺浠堕噰鐢ㄥ尟绶ㄨ獮(y菙)瑷€绶ㄥ(xi臎)锛岃粺浠惰ō(sh猫)瑷�(j矛)鍩轰簬涓茶閫氳▕妯″銆佹檪(sh铆)搴忔ā濉婂拰寮靛姏鎺у埗妯″銆備覆琛岄€氳▕妯″鍖呮嫭鎺ュ彈涓婁綅姗�(j墨)鏁�(sh霉)鎿�(j霉)銆佺疆妯�(bi膩o)蹇椾綅鍜屽悜涓婁綅姗�(j墨)鐧�(f膩)閫佹暩(sh霉)鎿�(j霉)绛�锛涙檪(sh铆)搴忔ā濉婂寘鎷皪(du矛)闁�(k膩i)闂�(gu膩n)鎿嶄綔鐨勯熆鎳�(y墨ng)锛岀郴绲�(t菕ng)閬�(y霉n)琛岀殑浠诲嫏(w霉)瑾�(di脿o)搴�锛岄€氳▕铏曠悊绛�锛涘嫉鍔涙帶鍒舵ā濉婂寘鎷嫉鍔涙暩(sh霉)鎿�(j霉)铏曠悊锛屽嫉鍔涢爯(y霉)铏曠悊鍜屽嫉鍔涙帶鍒剁瓑銆傚嫉鍔涙帶鍒朵富瑕佹槸閫氶亷(gu貌)灏�(du矛)寮靛姏瑾ゅ樊鐨勮檿鐞嗭紝閲囩敤宸ユキ(y猫)鎺у埗涓櫘閬嶉噰鐢ㄧ殑PID瑾�(di脿o)绡€(ji茅)鍣ㄦ帶鍒剁绮夊埗鍕�(d貌ng)鍣ㄥ拰纾佺矇闆㈠悎鍣ㄧ殑闆绘祦锛屽緸鑰屾帶鍒跺埗鍕�(d貌ng)杞�(zhu菐n)鐭�锛屼互淇濇寔寮靛姏鐨勬亽瀹氥€傚叾绋嬪簭娴佺▼鍦栬(ji脿n)鍦�3銆� 5 瀵�(sh铆)椹�(y脿n)绲�(ji茅)鏋� 鍦ㄦ帶鍒堕亷(gu貌)绋嬩腑锛屽悇榛�(di菐n)鐨勫嫉鍔涢€氶亷(gu貌)寮靛姏鍌虫劅鍣ㄥ弽楗嬮€佸埌寮靛姏鎺у埗鍣�锛屽嫉鍔涙帶鍒跺櫒鏄€氶亷(gu貌)绲﹀畾寮靛姏鑸囧嫉鍔涘偝鎰熷櫒鐨勫弽楗嬪嫉鍔涚殑宸€奸€�(j矛n)琛岃(di脿o)绡€(ji茅)鐨�銆傚嫉鍔涘偝鎰熷櫒杓稿嚭鐨勬槸闆诲淇¤櫉(h脿o)锛岀稉(j墨ng)閬�(gu貌)V锛廸璁婃彌鍚庤畩?y艒u)妲妢娌栦俊铏�(h脿o)锛�1000鍊�(g猫)鑴堟矕灏�(du矛)鎳�(y墨ng)30kg寮靛姏锛屽嵆姣忓€�(g猫)鑴堟矕灏�(du矛)鎳�(y墨ng)0锛�03kg鐨勫嫉鍔�銆傚皪(du矛)鏀惧嵎鍜屾敹鍗峰嫉鍔涙帶鍒跺櫒鐨勮几鍑烘瘡100ms閲囨ǎ涓€娆°€傚皣鎵€寰楁暩(sh霉)鎿�(j霉)缍�(j墨ng)閬�(gu貌)Matlab铏曠悊锛屽緱鏀惧嵎閮ㄥ垎鍜屾敹鍗烽儴鍒嗗嫉鍔涙帶鍒跺櫒鐨勮宸尝褰㈠垎鍒ュ鍦�4銆佸湒5鎵€绀�銆傚叾涓�锛屾瘡1鍊�(g猫)鑴堟矕浠ｈ〃0锛�03kg寮靛姏銆傜敱閲囨ǎ绲�(ji茅)鏋滅煡鎭掑嫉鍔涙帶鍒剁殑瑾ゅ樊鎺у埗鍦�0锛�1 kg浠�?x煤n)?n猫i)锛屽嫉鍔涙帶鍒跺櫒鐨勭郸瀹氬嫉鍔涚偤10 kg锛屽嫉鍔涙帶鍒跺櫒鐨勮宸帶鍒跺湪1锛呬互?x煤n)?n猫i)銆� 6 绲�(ji茅)鏉熻獮(y菙) 鏈枃瑷�(sh猫)瑷�(j矛)鐨勫嫉鍔涙帶鍒剁‖浠剁郴绲�(t菕ng)锛屼互TMS-320LF2407A鐐烘帶鍒惰姱鐗囷紝鍏锋湁绲�(ji茅)妲�(g貌u)绶婃箠銆佹姉骞叉摼鑳藉姏寮�(qi谩ng)銆佸揩閫熸€уソ銆佹€ц兘鍍�(ji脿)鏍兼瘮楂樼瓑鍎�(y艒u)榛�(di菐n)锛屽湪鎺у埗閬�(gu貌)绋嬩腑鍙栧緱浜嗚壇濂界殑鏁堟灉銆傞毃钁楀湅(gu贸)鍏�(n猫i)鍗板埛瑕佹眰鐨勫妯ｅ寲锛屽嵃鍒疯缃皣瓒婁締(l谩i)瓒婂厛閫�(j矛n)锛屽皪(du矛)寮靛姏鐨勬帶鍒惰姹傝秺渚�(l谩i)瓒婇珮锛屽熀浜嶥SP鐨勬亽寮靛姏鎺у埗绯荤当(t菕ng)灏囨渻(hu矛)鏈夊緢濂界殑鎳�(y墨ng)鐢ㄥ墠鏅�銆� 銆€ 渚�(l谩i)婧愶細闆绘埃鍌冲嫊(d貌ng)