Jun Suto / Mbed OS STM32F446_MG400_DIRECT_V0R17

Dependencies:  

Committer:
js
Date:
Fri Oct 21 10:54:03 2022 +0000
Revision:
2:71b3736a1bd7
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
js 2:71b3736a1bd7 1
js 2:71b3736a1bd7 2 //打点数カウント///
js 2:71b3736a1bd7 3 extern unsigned char WD1_CNT;
js 2:71b3736a1bd7 4 //極棒交換カウント///
js 2:71b3736a1bd7 5 extern unsigned long WD1_CHG_CNT;
js 2:71b3736a1bd7 6 //打点数カウント///
js 2:71b3736a1bd7 7 extern unsigned char WD2_CNT;
js 2:71b3736a1bd7 8 //極棒交換カウント///
js 2:71b3736a1bd7 9 extern unsigned long WD1H_CHG_CNT;//Φ4平極棒
js 2:71b3736a1bd7 10 extern unsigned long WD2H_CHG_CNT;//Φ3平極棒
js 2:71b3736a1bd7 11 extern unsigned long WD2R_CHG_CNT;//Φ3丸極棒
js 2:71b3736a1bd7 12 //回転制御シリンダー電磁弁状態0=OFF 1=0N
js 2:71b3736a1bd7 13 extern unsigned char RT1_ST;
js 2:71b3736a1bd7 14 extern unsigned char RT2_ST;
js 2:71b3736a1bd7 15
js 2:71b3736a1bd7 16 extern unsigned char WD_JUDG_1[8];//0=NG 1=OK
js 2:71b3736a1bd7 17 extern unsigned char WD_TCNT_1;//A+Cパーツの一括打点カウント
js 2:71b3736a1bd7 18 extern unsigned char WD_JUDG_2[8];//0=NG 1=OK
js 2:71b3736a1bd7 19 extern unsigned char WD_TCNT_2;//A+Cパーツの一括打点カウント
js 2:71b3736a1bd7 20 extern unsigned char WD_JUDG_NG_F;//NG有無 1=NGあり
js 2:71b3736a1bd7 21
js 2:71b3736a1bd7 22 #define EWAIT_DIS 0
js 2:71b3736a1bd7 23 #define EWAIT_ENB 1
js 2:71b3736a1bd7 24
js 2:71b3736a1bd7 25
js 2:71b3736a1bd7 26
js 2:71b3736a1bd7 27 #define MOVE_TIME_OUT 500
js 2:71b3736a1bd7 28
js 2:71b3736a1bd7 29 ////回転ヘッド電磁弁制御時間///
js 2:71b3736a1bd7 30 #define RT_ST_DEF 100
js 2:71b3736a1bd7 31
js 2:71b3736a1bd7 32
js 2:71b3736a1bd7 33
js 2:71b3736a1bd7 34 #define FETON 1
js 2:71b3736a1bd7 35 #define FETOFF 0
js 2:71b3736a1bd7 36 ////加圧軸1//////
js 2:71b3736a1bd7 37
js 2:71b3736a1bd7 38 #define PS1_POS_WAIT 1 //待機位置(後退)
js 2:71b3736a1bd7 39 #define PS1_POS_RT 2 //回転位置(中点)
js 2:71b3736a1bd7 40 #define PS1_POS_PU 3 //加圧位置(前進)
js 2:71b3736a1bd7 41
js 2:71b3736a1bd7 42 ////加圧軸2//////
js 2:71b3736a1bd7 43 #define PS2_POS_WAIT 1 //待機位置(後退)
js 2:71b3736a1bd7 44 #define PS2_POS_RT 2 //回転位置(中点)
js 2:71b3736a1bd7 45 #define PS2_POS_PU 3 //加圧位置(前進)
js 2:71b3736a1bd7 46
js 2:71b3736a1bd7 47 #define RT_BT_COL 34800
js 2:71b3736a1bd7 48
js 2:71b3736a1bd7 49 #define HEAD_ESC_EN 0
js 2:71b3736a1bd7 50 #define HEAD_ESC_DIS 1
js 2:71b3736a1bd7 51
js 2:71b3736a1bd7 52 ///2022/06/28///追加
js 2:71b3736a1bd7 53 #define WD_JUGE_OK 0
js 2:71b3736a1bd7 54 #define WD_JUGE_NG 1
js 2:71b3736a1bd7 55 ////////////溶接ヘッド回転制御/////////////////////
js 2:71b3736a1bd7 56 void WDRT1_CONT(unsigned char cont);
js 2:71b3736a1bd7 57 void HEAD1_RT(void);
js 2:71b3736a1bd7 58 void WDRT2_CONT(unsigned char cont);
js 2:71b3736a1bd7 59 void HEAD2_RT(void);
js 2:71b3736a1bd7 60
js 2:71b3736a1bd7 61 /////////////加圧軸1//////////////////////
js 2:71b3736a1bd7 62 ///原点復帰待ち//
js 2:71b3736a1bd7 63 void PS1_HOME_WAIT(unsigned long wait);
js 2:71b3736a1bd7 64 //待機位置(後退)移動待ち ST0 ON ST1 OFF
js 2:71b3736a1bd7 65 void PS1_PE0_WAIT(unsigned long wait);
js 2:71b3736a1bd7 66 //加圧位置(前進)移動待ち ST0 OFF ST1 ON
js 2:71b3736a1bd7 67 void PS1_PE1_WAIT(unsigned long wait);
js 2:71b3736a1bd7 68 //回転位置(中点)移動待ち ST0 OFF ST1 OFF
js 2:71b3736a1bd7 69 void PS1_PE2_WAIT(unsigned long wait);
js 2:71b3736a1bd7 70
js 2:71b3736a1bd7 71 ////////終了のみ待つ////
js 2:71b3736a1bd7 72 //待機位置(後退)移動完了待ち ST0 ON ST1 OFF
js 2:71b3736a1bd7 73 void PS1_PE0_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 74 //加圧位置(前進)移動完了待ち ST0 OFF ST1 ON
js 2:71b3736a1bd7 75 void PS1_PE1_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 76 //回転位置(中点)移動完了待ち ST0 OFF ST1 OFF
js 2:71b3736a1bd7 77 void PS1_PE2_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 78
js 2:71b3736a1bd7 79
js 2:71b3736a1bd7 80 //原点復帰///
js 2:71b3736a1bd7 81 void PS1_HOME(void);
js 2:71b3736a1bd7 82 //待機位置(後退)
js 2:71b3736a1bd7 83 void PS1_MOVE0(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 84 //回転位置(中点) ST0 OFF ST1 OFF
js 2:71b3736a1bd7 85 void PS1_MOVE1(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 86 //加圧位置(前進) ST0 OFF ST1 ON
js 2:71b3736a1bd7 87 void PS1_MOVE2(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 88
js 2:71b3736a1bd7 89
js 2:71b3736a1bd7 90 /////////////加圧軸2//////////////////////
js 2:71b3736a1bd7 91 ///原点復帰待ち//
js 2:71b3736a1bd7 92 void PS2_HOME_WAIT(unsigned long wait);
js 2:71b3736a1bd7 93 //待機位置(後退)移動待ち ST0 ON ST1 OFF
js 2:71b3736a1bd7 94 void PS2_PE0_WAIT(unsigned long wait);
js 2:71b3736a1bd7 95 //加圧位置(前進)移動待ち ST0 OFF ST1 ON
js 2:71b3736a1bd7 96 void PS2_PE1_WAIT(unsigned long wait);
js 2:71b3736a1bd7 97 //回転位置(中点)移動待ち ST0 OFF ST1 OFF
js 2:71b3736a1bd7 98 void PS2_PE2_WAIT(unsigned long wait);
js 2:71b3736a1bd7 99
js 2:71b3736a1bd7 100 ////////終了のみ待つ////
js 2:71b3736a1bd7 101 //待機位置(後退)移動待ち ST0 ON ST1 OFF
js 2:71b3736a1bd7 102 void PS2_PE0_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 103 //加圧位置(前進)移動待ち ST0 OFF ST1 ON
js 2:71b3736a1bd7 104 void PS2_PE1_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 105 //回転位置(中点)移動待ち ST0 OFF ST1 OFF
js 2:71b3736a1bd7 106 void PS2_PE2_EWAIT(unsigned long wait);
js 2:71b3736a1bd7 107
js 2:71b3736a1bd7 108 //原点復帰///
js 2:71b3736a1bd7 109 void PS2_HOME(void);
js 2:71b3736a1bd7 110 //待機位置(後退)
js 2:71b3736a1bd7 111 void PS2_MOVE0(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 112 //回転位置(中点) ST0 OFF ST1 OFF
js 2:71b3736a1bd7 113 void PS2_MOVE1(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 114 //加圧位置(前進) ST0 OFF ST1 ON
js 2:71b3736a1bd7 115 void PS2_MOVE2(unsigned char EWAIT_SEL);
js 2:71b3736a1bd7 116
js 2:71b3736a1bd7 117 //ヘッド1溶接動作//
js 2:71b3736a1bd7 118 void WD_HEAD1_START(unsigned char ch,unsigned char esc_dis);
js 2:71b3736a1bd7 119 //ヘッド2溶接動作//
js 2:71b3736a1bd7 120 void WD_HEAD2_START(unsigned char ch,unsigned char esc_dis);
js 2:71b3736a1bd7 121 ///両軸同時退避///
js 2:71b3736a1bd7 122 void WD_HEAD_ESC();
js 2:71b3736a1bd7 123
js 2:71b3736a1bd7 124 //ヘッド1溶接動作テスト//
js 2:71b3736a1bd7 125 void WD_HEAD1_START_TEST(unsigned char ch,unsigned char esc_dis);
js 2:71b3736a1bd7 126 //ヘッド2溶接動作テスト//
js 2:71b3736a1bd7 127 void WD_HEAD2_START_TEST(unsigned char ch,unsigned char esc_dis);
js 2:71b3736a1bd7 128
js 2:71b3736a1bd7 129 ///ヘッド1,2半同時動作///
js 2:71b3736a1bd7 130 void WD_START();
js 2:71b3736a1bd7 131
js 2:71b3736a1bd7 132 //判定結果保持配列のクリア///
js 2:71b3736a1bd7 133 void WD_JUDG_CLR();