CoDeSys鍏ラ棬瀹炴垬涓�璧峰�︿範锛堜簩鍗佸叓锛夛細锛團BD锛変笁鍙扮數鏈洪『璧烽�嗗仠绋嬪簭璇﹁В鈥斾笂鍗囥�佷笅闄嶆部浣跨敤涓�

tt99166

缃戠粶5锛氶�嗗簭鍋滄�㈤�昏緫锛堟牳蹇冩椂搴忔帶鍒讹級
閫嗗簭鍋滄�㈤�昏緫鍒嗕负4閮ㄥ垎锛屽疄鐜般�孧3绔嬪嵆鍋滄�⑩啋寤舵椂鈫扢2鍋滄�⑩啋寤舵椂鈫扢1鍋滄��銆嶇殑鏃跺簭锛屽仠姝㈠懡浠よЕ鍙戝悗锛屼紭鍏堝仠姝㈡渶鍚庡惎鍔ㄧ殑鐢垫満锛岄伩鍏嶈�惧�囧啿鍑汇��
5.1 鍋滄�㈠懡浠よЕ鍙戯紙鍚�鍔ㄥ仠姝㈡椂搴忥級

閫昏緫瑙ｆ瀽锛� 褰撴湁鍋滄�㈠懡浠わ紙bStopCmd=TRUE锛変笖绯荤粺姝ｅ湪杩愯�岋紙bSystemRunning=TRUE锛夋椂锛岃Е鍙戝仠姝㈠畾鏃跺櫒StopTimer1鐨勮緭鍏ワ紙StopTimer1.IN=TRUE锛夛紝寮�濮嬪仠姝㈡椂搴忋��
5.2 绔嬪嵆鍋滄�㈢數鏈�3锛堝仠姝㈡祦绋嬬��涓�姝ワ級
閫昏緫瑙ｆ瀽锛� 鍋滄�㈠懡浠わ紙bStopCmd=TRUE锛夎Е鍙戝悗锛岀珛鍗虫墽琛屽�嶄綅鎸囦护锛圧ST锛夛紝Motor3_Run=FALSE锛圡3鎺ヨЕ鍣ㄦ柇寮�锛岀數鏈虹珛鍗冲仠姝�锛夈��
涓轰粈涔堢珛鍗冲仠姝�M3锛� 閫嗗簭鍋滄�㈢殑鏍稿績鏄�銆屽厛鍋滄渶鍚庡惎鍔ㄧ殑鐢垫満銆嶏紝M3鏄�鏈�鍚庡惎鍔ㄧ殑锛屼紭鍏堝仠姝�M3鍙�閬垮厤鍏惰礋杞藉�瑰墠涓ゅ彴鐢垫満閫犳垚鍐插嚮锛屼繚闅滆�惧�囧畨鍏ㄣ��
5.3 寤舵椂5绉掑仠姝㈢數鏈�2锛堝仠姝㈡祦绋嬬��浜屾�ワ級

瑙ｆ瀽锛�

瀹氭椂鍣ㄥ惎鍔�锛氬仠姝㈠懡浠わ紙bStopCmd=TRUE锛夎Е鍙戝悗锛孲topTimer1寮�濮嬭�℃椂锛堣�℃椂鏃堕棿=StopInterval锛岄粯璁�5绉掞級锛�

鐢垫満2鍋滄��锛氬綋StopTimer1.Q=TRUE锛堣�℃椂瀹屾垚锛夛紝鎵ц�屽�嶄綅鎸囦护锛孧otor2_Run=FALSE锛圡2鎺ヨЕ鍣ㄦ柇寮�锛岀數鏈哄仠姝�锛夈��

5.4 鍐嶅欢鏃�5绉掑仠姝㈢數鏈�1锛堝仠姝㈡祦绋嬬��涓夋�ワ級
閫昏緫瑙ｆ瀽锛�

瀹氭椂鍣ㄥ惎鍔�锛歋topTimer1.Q=TRUE锛圡2宸插仠姝�锛夊悗锛孲topTimer2寮�濮嬭�℃椂锛堝欢鏃�5绉掞級锛�

鐢垫満1鍋滄��锛氬綋StopTimer2.Q=TRUE锛堣�℃椂瀹屾垚锛夛紝鎵ц�屽�嶄綅鎸囦护锛孧otor1_Run=FALSE锛圡1鎺ヨЕ鍣ㄦ柇寮�锛岀數鏈哄仠姝�锛夛紝姝ゆ椂鎵�鏈夌數鏈哄叏閮ㄥ仠姝�銆�

鍋滄�㈡椂搴忔�荤粨锛�

T=0绉掞細鎸変笅鍋滄�㈡寜閽� 鈫� bStopCmd=TRUE 鈫� M3绔嬪嵆鍋滄��锛圡otor3_Run=FALSE锛夛紝StopTimer1寮�濮嬭�℃椂                         T=5绉掞細StopTimer1璁℃椂瀹屾垚锛圫topTimer1.Q=TRUE锛� 鈫� M2鍋滄��锛圡otor2_Run=FALSE锛夛紝StopTimer2寮�濮嬭�℃椂                         T=10绉掞細StopTimer2璁℃椂瀹屾垚锛圫topTimer2.Q=TRUE锛� 鈫� M1鍋滄��锛圡otor1_Run=FALSE锛夛紝鎵�鏈夌數鏈哄仠姝�

缃戠粶6锛氭晠闅滀繚鎶ら�昏緫锛堢數鏈鸿繃鐑�淇濇姢锛岃繛閿佸仠姝�锛�
鏁呴殰淇濇姢閫昏緫閽堝�规瘡鍙扮數鏈虹殑鐑�缁х數鍣ㄥ弽棣堜俊鍙凤紙Motor1_OK銆丮otor2_OK銆丮otor3_OK锛夛紝瀹炵幇銆屾晠闅滅數鏈哄仠姝�+杩為攣淇濇姢銆嶏紝閬垮厤鏁呴殰鎵╁ぇ銆�

6.1 鐢垫満1鏁呴殰澶勭悊
閫昏緫瑙ｆ瀽锛�

鏁呴殰妫�娴嬶細褰揗otor1_OK=FALSE锛圡1鐑�缁х數鍣ㄥ姩浣滐紝鐢垫満杩囩儹鏁呴殰锛夛紝鎵ц�岀疆浣嶆寚浠わ紝FaultMotor=1锛堣�板綍鏁呴殰鐢垫満涓篗1锛夛紱

杩為攣鍋滄��锛欶aultMotor=1锛堟��娴嬪埌M1鏁呴殰锛夋椂锛屽悓鏃跺�嶄綅Motor1_Run銆丮otor2_Run銆丮otor3_Run锛屽仠姝㈡墍鏈夌數鏈恒��

涓轰粈涔堝仠姝㈡墍鏈夌數鏈猴紵 M1鏄�鏁翠釜鍚�鍔ㄦ祦绋嬬殑鍩虹��锛孧1鏁呴殰鍚庯紝M2銆丮3澶卞幓鍚�鍔ㄥ墠鎻愶紝缁х画杩愯�屼細瀵艰嚧璁惧�囪礋杞藉紓甯革紝鐢氳嚦鎹熷潖璁惧�囷紝鍥犳�ら噰鐢ㄦ渶涓ユ牸鐨勮繛閿佷繚鎶ゃ��
6.2 鐢垫満2鏁呴殰澶勭悊锛堣繛閿佸仠姝�M2銆丮3锛�
閫昏緫瑙ｆ瀽锛� 褰揗otor2_OK=FALSE锛圡2鏁呴殰锛夛紝FaultMotor=2锛堣�板綍鏁呴殰鐢垫満涓篗2锛夛紝鍚屾椂澶嶄綅Motor2_Run銆丮otor3_Run锛堝仠姝�M2銆丮3锛夛紝M1鍙�缁х画杩愯�岋紙鑻�M1鏃犳晠闅滐級锛屽噺灏戠敓浜ф崯澶便��
6.3 鐢垫満3鏁呴殰澶勭悊锛堜粎鍋滄��M3锛�
閫昏緫瑙ｆ瀽锛� 褰揗otor3_OK=FALSE锛圡3鏁呴殰锛夛紝FaultMotor=3锛堣�板綍鏁呴殰鐢垫満涓篗3锛夛紝浠呭�嶄綅Motor3_Run锛堝仠姝�M3锛夛紝M1銆丮2鍙�缁х画杩愯�岋紝鏈�澶ч檺搴︿繚闅滅敓浜ц繛缁�鎬с��
缃戠粶7锛氭晠闅滃�嶄綅鏈哄埗
缁勪欢瑙ｆ瀽锛�

[ > ]锛氭瘮杈冩寚浠わ紝鍒ゆ柇FaultMotor>0锛堢郴缁熷瓨鍦ㄦ晠闅滐級锛�

[ MOV 0, FaultMotor ]锛氳祴鍊兼寚浠わ紝灏�0浼犵粰FaultMotor锛堟竻闄ゆ晠闅滆�板綍锛夈��

鏁呴殰澶嶄綅閫昏緫锛�

鏁呴殰鍙戠敓鍚庯紝FaultMotor淇濆瓨鏁呴殰鐢垫満缂栧彿锛�1/2/3锛夛紝绯荤粺鏁呴殰鎸囩ず鐏�锛圫ystem_Fault锛変寒璧凤紝鎻愰啋鎿嶄綔浜哄憳澶勭悊鏁呴殰锛�

鏁呴殰鎺掗櫎鍚庯紝闇�鎵嬪姩澶嶄綅锛氭寜涓嬪惎鍔ㄦ寜閽�锛圫tart=TRUE锛夛紝姝ゆ椂FaultMotor>0锛岃祴鍊兼寚浠よЕ鍙戯紝FaultMotor=0锛堟竻闄ゆ晠闅滆�板綍锛夛紝鏁呴殰鎸囩ず鐏�鐔勭伃锛�

澶嶄綅鍚庯紝绯荤粺鍙�閲嶆柊鎸変笅鍚�鍔ㄦ寜閽�锛屽紑濮嬮『搴忓惎鍔ㄣ��

涓轰粈涔堢敤鍚�鍔ㄦ寜閽�澶嶄綅锛� 绗﹀悎宸ヤ笟瀹夊叏瑙勮寖锛屾晠闅滃悗蹇呴』鐢辨搷浣滀汉鍛樹汉宸ョ‘璁わ紙鎺掗櫎鏁呴殰鍚庯級锛屾墠鑳藉�嶄綅鍚�鍔�锛岄槻姝㈡晠闅滆嚜鍔ㄥ�嶄綅瀵艰嚧璁惧�囪��鍚�鍔�锛屽紩鍙戝畨鍏ㄤ簨鏁呫��
缃戠粶8锛氱姸鎬佹寚绀虹郴缁燂紙鐜板満鍙�瑙嗗寲锛屼究浜庣淮鎶わ級
鐘舵�佹寚绀虹郴缁熷垎涓�4閮ㄥ垎锛屽垎鍒�鏄剧ず绯荤粺鏁翠綋鐘舵�佸拰姣忓彴鐢垫満鐨勭嫭绔嬬姸鎬侊紝渚夸簬鐜板満鎿嶄綔浜哄憳瑙傚療绯荤粺杩愯�屾儏鍐碉紝蹇�閫熷畾浣嶆晠闅溿��
5.1 璋冭瘯姝ラ�わ紙CoDeSys浠跨湡/鐜板満璋冭瘯閫氱敤锛�
绗�涓�姝ワ細妫�鏌ヨ緭鍏ヤ俊鍙凤紙瀹夊叏鍓嶆彁锛�

// 璋冭瘯鍓嶏紝纭�璁ゆ墍鏈夊畨鍏ㄤ俊鍙锋�ｅ父锛圕oDeSys浠跨湡涓�鍙�鎵嬪姩淇�鏀瑰彉閲忓�硷級                         EmergencyStop = TRUE;  // 鎬ュ仠鎸夐挳鏈�鎸変笅锛堝父闂�瑙︾偣闂�鍚堬級                         Motor1_OK = TRUE;     // 鐢垫満1鏃犳晠闅�                         Motor2_OK = TRUE;     // 鐢垫満2鏃犳晠闅�                         Motor3_OK = TRUE;     // 鐢垫満3鏃犳晠闅�

绗�浜屾�ワ細娴嬭瘯鍗曞彴鐢垫満锛堝崟鐙�楠岃瘉锛�

// 涓存椂淇�鏀圭▼搴忥紝娴嬭瘯姣忓彴鐢垫満鐙�绔嬪惎鍋滐紙鎺掗櫎鐢垫満鏈�韬�鏁呴殰锛�                         // 鏂规硶锛氬皢Motor1_Run銆丮otor2_Run銆丮otor3_Run鍒嗗埆鐩存帴鍏宠仈Start鎸夐挳

绗�涓夋�ワ細娴嬭瘯椤哄簭鍚�鍔�锛堟牳蹇冩椂搴忥級

// 鎭㈠�嶇▼搴忥紝鎸変笅鍚�鍔ㄦ寜閽�锛岃�傚療鏃跺簭鏄�鍚︾�﹀悎瑕佹眰                         // 姝ｅ父鏃跺簭锛歁1鍚�鍔� 鈫� 5绉� 鈫� M2鍚�鍔� 鈫� 5绉� 鈫� M3鍚�鍔�                         // 閲嶇偣瑙傚療锛氬畾鏃跺櫒StartTimer1銆丼tartTimer2鐨勮�℃椂鏄�鍚︽�ｅ父锛圗T鍊兼槸鍚﹂�掑�烇級

绗�鍥涙�ワ細娴嬭瘯閫嗗簭鍋滄��锛堟牳蹇冩椂搴忥級

// 涓夊彴鐢垫満鍏ㄩ儴杩愯�屽悗锛屾寜涓嬪仠姝㈡寜閽�锛岃�傚療鏃跺簭鏄�鍚︾�﹀悎瑕佹眰                         // 姝ｅ父鏃跺簭锛歁3绔嬪嵆鍋滄�� 鈫� 5绉� 鈫� M2鍋滄�� 鈫� 5绉� 鈫� M1鍋滄��                         // 閲嶇偣瑙傚療锛氬畾鏃跺櫒StopTimer1銆丼topTimer2鐨勮�℃椂鏄�鍚︽�ｅ父

绗�浜旀�ワ細娴嬭瘯鏁呴殰淇濇姢锛堝畨鍏ㄩ獙璇侊級

// 妯℃嫙鐢垫満鏁呴殰锛岄獙璇佽繛閿佷繚鎶ら�昏緫                         1. 妯℃嫙M1鏁呴殰锛氳�剧疆Motor1_OK=FALSE 鈫� 瑙傚療M1銆丮2銆丮3鏄�鍚﹀叏閮ㄥ仠姝�锛孎aultMotor=1                         2. 妯℃嫙M2鏁呴殰锛氳�剧疆Motor2_OK=FALSE 鈫� 瑙傚療M2銆丮3鏄�鍚﹀仠姝�锛孧1鏄�鍚︾户缁�杩愯�岋紝FaultMotor=2                         3. 妯℃嫙M3鏁呴殰锛氳�剧疆Motor3_OK=FALSE 鈫� 瑙傚療M3鏄�鍚﹀仠姝�锛孧1銆丮2鏄�鍚︾户缁�杩愯�岋紝FaultMotor=3

绗�鍏�姝ワ細娴嬭瘯鎬ュ仠鍔熻兘锛堟渶楂樹紭鍏堢骇楠岃瘉锛�

// 绯荤粺杩愯�屼腑锛屾寜涓嬫�ュ仠鎸夐挳锛堣�剧疆EmergencyStop=FALSE锛�                         // 瑙傚療锛氭墍鏈夌數鏈烘槸鍚︾珛鍗冲仠姝�锛宐Emergency=TRUE锛孲ystem_Fault=TRUE

5.2 甯歌�侀棶棰樺�勭悊锛堟柊鎵嬮伩鍧戯級

闂�棰樼幇璞�	鍙�鑳藉師鍥�	瑙ｅ喅鏂规��
鎵�鏈夌數鏈烘棤娉曞惎鍔�	1. 鎬ュ仠鎸夐挳鏈�澶嶄綅锛圗mergencyStop=FALSE锛夛紱2. 鐢垫満1鏁呴殰锛圡otor1_OK=FALSE锛�	1. 澶嶄綅鎬ュ仠鎸夐挳锛岀‘淇滶mergencyStop=TRUE锛�2. 妫�鏌�Motor1_OK淇″彿锛屾帓闄�M1鏁呴殰
鍙�鏈塎1鑳藉惎鍔�锛孧2銆丮3鏃犳硶鍚�鍔�	1. 瀹氭椂鍣⊿tartTimer1鏈�璁℃椂锛圡otor1_OK=FALSE锛夛紱2. Motor2_OK鎴朚otor3_OK涓篎ALSE	1. 妫�鏌�Motor1_OK淇″彿锛岀‘淇滿1姝ｅ父杩愯�岋紱2. 妫�鏌�Motor2_OK銆丮otor3_OK淇″彿
鍋滄�㈠悗鏃犳硶鍐嶅惎鍔�	鏁呴殰鏈�澶嶄綅锛團aultMotor>0锛�	鎸変笅鍚�鍔ㄦ寜閽�锛屾墜鍔ㄥ�嶄綅鏁呴殰锛團aultMotor=0锛�
鍚�鍔ㄩ『搴忔贩涔憋紙姣斿�侻1銆丮2鍚屾椂鍚�鍔�锛�	瀹氭椂鍣ㄨ�剧疆閿欒��锛圫tartInterval鏈�璁剧疆鍗曚綅鎴栧�奸敊璇�锛�	妫�鏌�StartInterval锛岃�剧疆涓篢#5S锛堝甫鍗曚綅锛夛紝纭�淇濆畾鏃跺櫒姝ｅ父璁℃椂
鎬ュ仠鏃犳晥	1. 鎬ュ仠鎸夐挳鎺ョ嚎閿欒��锛堟帴鎴愬父寮�锛夛紱2. 绋嬪簭涓�鎬ュ仠瑙︾偣绫诲瀷閿欒��	1. 灏嗘�ュ仠鎸夐挳鏀逛负甯搁棴鎺ョ嚎锛�2. 妫�鏌ョ綉缁�1锛岀‘淇滶mergencyStop涓哄父闂�瑙︾偣锛坾/|锛�

5.3 鍙傛暟璋冩暣寤鸿��
鏍规嵁鐢垫満鍔熺巼鍜岀幇鍦洪渶姹傦紝鍙�璋冩暣鏃堕棿鍙傛暟锛屼互涓嬫槸甯歌�佸満鏅�鐨勫弬鏁板缓璁�锛�

// 1. 澶у姛鐜囩數鏈猴紙10KW浠ヤ笂锛夛細寤堕暱寤舵椂鏃堕棿锛岄伩鍏嶅惎鍔ㄧ數娴佸啿鍑�                         StartInterval := T#8S;  // 鍚�鍔ㄩ棿闅旇皟鏁翠负8-10绉�                         StopInterval := T#8S;   // 鍋滄�㈤棿闅旇皟鏁翠负8-10绉�                         // 2. 蹇�閫熸祴璇曠▼搴忥細缂╃煭寤舵椂鏃堕棿锛屾彁楂樿皟璇曟晥鐜�                         StartInterval := T#2S;  // 娴嬭瘯鏃剁敤2绉�                         StopInterval := T#2S;

浣滅敤锛氶�傞厤鑷�鍔ㄥ寲鐢熶骇绾跨殑闆嗕腑鐩戞帶闇�姹傦紝鎿嶄綔浜哄憳鍙�鍦ㄤ笂浣嶆満锛堢數鑴戙�佽Е鎽稿睆锛変笂鐩戞帶鐢垫満鐘舵�侊紝鏃犻渶鍒扮幇鍦恒��
涓冦�佹�荤粨
鏈�鏂囪�︾粏鎷嗚В鐨勪笁鍙扮數鏈洪『璧烽�嗗仠绋嬪簭锛屾槸宸ヤ笟鑷�鍔ㄥ寲涓�鐨勭粡鍏稿簲鐢�锛屾牳蹇冧寒鐐圭殑鏄�銆屾椂搴忔竻鏅般�佸畨鍏ㄥ彲闈犮�佹敞閲婂畬鏁淬�佹槗浜庡�嶇敤銆嶏紝鏂版墜鍙�閫氳繃鏈�绋嬪簭锛岀啛缁冩帉鎻�CoDeSys涓�瀹氭椂鍣�锛圱ON锛夈�佷笂鍗囨部妫�娴嬨�佺疆浣�/澶嶄綅鎸囦护銆佹瘮杈冩寚浠ょ殑缁煎悎搴旂敤锛屽悓鏃剁悊瑙ｅ伐涓氭帶鍒朵腑鐨勫畨鍏ㄨ�勮寖锛堟�ュ仠浼樺厛绾с�佹墜鍔ㄦ晠闅滃�嶄綅銆佺‖浠朵簰閿侊級銆�
绋嬪簭鐨勬牳蹇冮�昏緫鐨勬槸銆岄『搴忓惎鍔ㄣ�侀�嗗簭鍋滄��銆嶏紝閫氳繃瀹氭椂鍣ㄥ疄鐜板欢鏃惰仈鍔�锛岄�氳繃鏍囧織浣嶅疄鐜伴�昏緫閿佸瓨锛岄�氳繃鏁呴殰妫�娴嬪疄鐜拌繛閿佷繚鎶わ紝瀹屽叏閫傞厤鐜板満瀹為檯搴旂敤闇�姹傦紝鍙�鐩存帴澶嶅埗鍒癈oDeSys涓�锛屼慨鏀笽O鍦板潃鍜屾椂闂村弬鏁板悗锛屽嵆鍙�鎶曞叆浣跨敤銆�
鎺屾彙鏈�绋嬪簭鐨勮�捐�℃�濊矾鍚庯紝鍙�杞绘澗鎵╁睍鍒板洓鍙般�佷簲鍙扮數鏈虹殑椤哄簭鎺у埗锛屼负鍚庣画瀛︿範鏇村�嶆潅鐨勫伐涓氭帶鍒剁郴缁燂紙濡傜敓浜х嚎鑱斿姩銆佸�氳�惧�囧崗鍚岋級鎵撲笅鍧氬疄鍩虹��銆�