ryou sato / Mbed 2 deprecated LPC11U35_CTswitch_relay

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed LPC11U35_MCP41HV51-503EST

main.cpp@4:e69f73c66598, 2020-08-30 (annotated)

Committer:
ryousato
Date:
Sun Aug 30 11:40:51 2020 +0000
Revision:
4:e69f73c66598
Parent:
3:d55ebd20d750
Child:
5:5d7483b46cda
2020/08/30

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ryousato 0:df1e1f84ded8 1 //////////////////////////////////////////////////
ryousato 0:df1e1f84ded8 2 // Include Files
ryousato 0:df1e1f84ded8 3 #include "mbed.h"
ryousato 0:df1e1f84ded8 4 #include "LPC11Uxx.h"
ryousato 0:df1e1f84ded8 5 #include "USBSerial.h"
ryousato 0:df1e1f84ded8 6 //////////////////////////////////////////////////
ryousato 0:df1e1f84ded8 7
ryousato 0:df1e1f84ded8 8 //Configure the PC Serial Port for CDC USB
ryousato 0:df1e1f84ded8 9 USBSerial serial;
ryousato 0:df1e1f84ded8 10 Serial device(P0_19,P0_18);
ryousato 3:d55ebd20d750 11 Ticker OffsetCal;
ryousato 3:d55ebd20d750 12 Ticker timerint;
ryousato 3:d55ebd20d750 13 Timer timecount;
ryousato 0:df1e1f84ded8 14
ryousato 0:df1e1f84ded8 15 //Pin Defines
ryousato 3:d55ebd20d750 16 DigitalOut led1(LED1);
ryousato 0:df1e1f84ded8 17
ryousato 3:d55ebd20d750 18 char moji[32]; //入力文字列
ryousato 3:d55ebd20d750 19 int suuji[6];
ryousato 3:d55ebd20d750 20 int count = 0; //文字数カウンタ
ryousato 3:d55ebd20d750 21 int CorF;
ryousato 3:d55ebd20d750 22 int adjmode;
ryousato 3:d55ebd20d750 23 int val; //POTのワイパー移動数
ryousato 3:d55ebd20d750 24 int incr;
ryousato 3:d55ebd20d750 25 int wa;
ryousato 3:d55ebd20d750 26 int mode_p = 0;
ryousato 3:d55ebd20d750 27 int *pmode;
ryousato 3:d55ebd20d750 28 float Vcc = 3.292; //実測値を入力すること
ryousato 3:d55ebd20d750 29 float Vref;
ryousato 4:e69f73c66598 30 float ActualVref[4] = {1.65, 1.65, 1.65, 1.65};
ryousato 3:d55ebd20d750 31 float *pAVrefcal;
ryousato 3:d55ebd20d750 32 int AD_flag;
ryousato 3:d55ebd20d750 33 float AD_val = 0;
ryousato 3:d55ebd20d750 34 float AD_val_sum = 0;
ryousato 3:d55ebd20d750 35 float Vrms = 0;
ryousato 3:d55ebd20d750 36 float set_val = 0;
ryousato 3:d55ebd20d750 37 float diff = 0;
ryousato 3:d55ebd20d750 38 //float zero_cal[2];
ryousato 3:d55ebd20d750 39 int AD_count = 0;
ryousato 3:d55ebd20d750 40 float setval = 0;
ryousato 3:d55ebd20d750 41
ryousato 1:88f0bc1e1aff 42
ryousato 0:df1e1f84ded8 43 DigitalOut coilEN1(P0_1);
ryousato 0:df1e1f84ded8 44 DigitalOut coilEN2(P0_2);
ryousato 0:df1e1f84ded8 45 DigitalOut coilEN3(P0_3);
ryousato 0:df1e1f84ded8 46 DigitalOut coilEN4(P0_4);
ryousato 0:df1e1f84ded8 47 DigitalOut coilEN5(P0_5);
ryousato 0:df1e1f84ded8 48 DigitalOut coilEN6(P0_20);
ryousato 0:df1e1f84ded8 49 DigitalOut coilEN7(P1_19);
ryousato 0:df1e1f84ded8 50
ryousato 0:df1e1f84ded8 51 DigitalOut ENn(P0_16);
ryousato 0:df1e1f84ded8 52 DigitalOut addr0(P0_17);
ryousato 0:df1e1f84ded8 53 DigitalOut addr1(P0_18);
ryousato 0:df1e1f84ded8 54 DigitalOut addr2(P0_19);
ryousato 0:df1e1f84ded8 55
ryousato 0:df1e1f84ded8 56 DigitalOut SCT_AMP(P0_10);
ryousato 0:df1e1f84ded8 57 DigitalOut WLATn(P0_23);
ryousato 0:df1e1f84ded8 58 DigitalOut SHDNn(P1_15);
ryousato 0:df1e1f84ded8 59
ryousato 3:d55ebd20d750 60 AnalogIn AD_TRANS_IN(P0_11); //AD_TRANS_IN
ryousato 3:d55ebd20d750 61 AnalogIn AD_CT_IN(P0_12); //AD_CT_IN
ryousato 3:d55ebd20d750 62
ryousato 0:df1e1f84ded8 63
ryousato 1:88f0bc1e1aff 64 SPI spi(P0_9, P0_8, P0_6);
ryousato 2:5e6613f149d4 65
ryousato 1:88f0bc1e1aff 66 void setup() {
ryousato 2:5e6613f149d4 67 spi.format(16,0);
ryousato 3:d55ebd20d750 68 wait(0.02);
ryousato 2:5e6613f149d4 69 spi.frequency(1000000);
ryousato 1:88f0bc1e1aff 70 device.baud(115200);
ryousato 0:df1e1f84ded8 71
ryousato 3:d55ebd20d750 72 coilEN1 = 0; //50Hz
ryousato 3:d55ebd20d750 73 coilEN2 = 0; //TRANS_OUT調整
ryousato 3:d55ebd20d750 74 coilEN3 = 0; //CT1,2_OUT調整
ryousato 3:d55ebd20d750 75 coilEN4 = 0; //CT1,2_OUT選択
ryousato 3:d55ebd20d750 76 coilEN5 = 0; //±5V,±15 OFF
ryousato 3:d55ebd20d750 77 coilEN6 = 0; //未使用
ryousato 3:d55ebd20d750 78 coilEN7 = 0; //未使用
ryousato 0:df1e1f84ded8 79
ryousato 3:d55ebd20d750 80 ENn = 1; //CD74HC4051E CSをディセーブル
ryousato 0:df1e1f84ded8 81 addr0 = 0;
ryousato 0:df1e1f84ded8 82 addr1 = 0;
ryousato 0:df1e1f84ded8 83 addr2 = 0;
ryousato 0:df1e1f84ded8 84
ryousato 3:d55ebd20d750 85 WLATn = 1; //MCP41HV51-503EST ワイパーラッチ
ryousato 3:d55ebd20d750 86 SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
ryousato 3:d55ebd20d750 87 SHDNn = 0; //電流帰還アンプ シャットダウンしない
ryousato 2:5e6613f149d4 88 }
ryousato 0:df1e1f84ded8 89
ryousato 2:5e6613f149d4 90 void serialstart(){
ryousato 3:d55ebd20d750 91 wait(0.02);
ryousato 3:d55ebd20d750 92 serial.printf("\r\nReady!\r\n");
ryousato 3:d55ebd20d750 93 wait(0.02);
ryousato 0:df1e1f84ded8 94 }
ryousato 0:df1e1f84ded8 95
ryousato 0:df1e1f84ded8 96 void helpwrite(){
ryousato 3:d55ebd20d750 97 serial.printf("\r\n------------------");
ryousato 3:d55ebd20d750 98 //serial.printf("\r\ncmd");
ryousato 3:d55ebd20d750 99 serial.printf("\r\nhelp");
ryousato 3:d55ebd20d750 100 //serial.printf("\r\n?");
ryousato 3:d55ebd20d750 101 serial.printf("\r\ninitial");
ryousato 3:d55ebd20d750 102 serial.printf("\r\nV_OFF");
ryousato 3:d55ebd20d750 103 serial.printf("\r\nV_ON");
ryousato 3:d55ebd20d750 104 serial.printf("\r\n50Hz");
ryousato 3:d55ebd20d750 105 serial.printf("\r\n60Hz");
ryousato 3:d55ebd20d750 106 serial.printf("\r\nTRANS_OUT_ADINT");
ryousato 3:d55ebd20d750 107 serial.printf("\r\nCT1_OUT_ADINT");
ryousato 3:d55ebd20d750 108 serial.printf("\r\nCT2_OUT_ADINT");
ryousato 3:d55ebd20d750 109 serial.printf("\r\nTRANS_OUT_EXT");
ryousato 4:e69f73c66598 110 serial.printf("\r\nCT_OUT_EXT");
ryousato 4:e69f73c66598 111 serial.printf("\r\nTRANS_offset");
ryousato 4:e69f73c66598 112 serial.printf("\r\nCT1_offset");
ryousato 4:e69f73c66598 113 serial.printf("\r\nCT2_offset");
ryousato 4:e69f73c66598 114 serial.printf("\r\ndispVref");
ryousato 3:d55ebd20d750 115 serial.printf("\r\nTRANS_ADJ");
ryousato 3:d55ebd20d750 116 serial.printf("\r\nCT1_ADJ");
ryousato 3:d55ebd20d750 117 serial.printf("\r\nCT2_ADJ");
ryousato 3:d55ebd20d750 118 serial.printf("\r\nMANUAL_TRANS_ADJ");
ryousato 3:d55ebd20d750 119 serial.printf("\r\nMANUAL_CT1_ADJ");
ryousato 3:d55ebd20d750 120 serial.printf("\r\nMANUAL_CT2_ADJ");
ryousato 3:d55ebd20d750 121 serial.printf("\r\n------------------");
ryousato 0:df1e1f84ded8 122 }
ryousato 0:df1e1f84ded8 123
ryousato 3:d55ebd20d750 124 //MCP41HV51コマンド
ryousato 3:d55ebd20d750 125 //デバッグ用
ryousato 3:d55ebd20d750 126 void TCON(){ //端子スイッチ接続
ryousato 2:5e6613f149d4 127 int whoami = spi.write(0x40FF);
ryousato 3:d55ebd20d750 128 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 2:5e6613f149d4 129 }
ryousato 2:5e6613f149d4 130
ryousato 3:d55ebd20d750 131 //デバッグ用
ryousato 2:5e6613f149d4 132 void TCONread(){
ryousato 2:5e6613f149d4 133 int whoami = spi.write(0x4C00);
ryousato 3:d55ebd20d750 134 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 3:d55ebd20d750 135 }
ryousato 3:d55ebd20d750 136
ryousato 3:d55ebd20d750 137 //デバッグ用
ryousato 3:d55ebd20d750 138 void read(){
ryousato 3:d55ebd20d750 139 int read_val = spi.write(0x0C00);
ryousato 3:d55ebd20d750 140 serial.printf("\r\nread_val = 0x%X", read_val);
ryousato 3:d55ebd20d750 141 }
ryousato 3:d55ebd20d750 142
ryousato 3:d55ebd20d750 143 //デバッグ用
ryousato 3:d55ebd20d750 144 void write00(){
ryousato 3:d55ebd20d750 145 int whoami = spi.write(0x0000);
ryousato 3:d55ebd20d750 146 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 2:5e6613f149d4 147 }
ryousato 2:5e6613f149d4 148
ryousato 3:d55ebd20d750 149 //デバッグ用
ryousato 3:d55ebd20d750 150 void write7F(){
ryousato 3:d55ebd20d750 151 int whoami = spi.write(0x007F);
ryousato 3:d55ebd20d750 152 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 2:5e6613f149d4 153 }
ryousato 2:5e6613f149d4 154
ryousato 3:d55ebd20d750 155 //デバッグ用
ryousato 3:d55ebd20d750 156 void writeFF(){
ryousato 2:5e6613f149d4 157 int whoami = spi.write(0x00FF);
ryousato 3:d55ebd20d750 158 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 3:d55ebd20d750 159 }
ryousato 3:d55ebd20d750 160
ryousato 3:d55ebd20d750 161 //デバッグ用
ryousato 3:d55ebd20d750 162 void TENinc(){
ryousato 3:d55ebd20d750 163 int readval = spi.write(0x0C00);
ryousato 3:d55ebd20d750 164 int incval = readval & 0xFF;
ryousato 3:d55ebd20d750 165 incval = incval + 10;
ryousato 3:d55ebd20d750 166 int whoami = spi.write(incval);
ryousato 3:d55ebd20d750 167 serial.printf("\r\nWHOAMI register = 0x%X", whoami);
ryousato 2:5e6613f149d4 168 }
ryousato 2:5e6613f149d4 169
ryousato 2:5e6613f149d4 170 void WLAT(){
ryousato 2:5e6613f149d4 171 WLATn = 0;
ryousato 3:d55ebd20d750 172 wait(0.02);
ryousato 3:d55ebd20d750 173 WLATn = 1;
ryousato 3:d55ebd20d750 174 //serial.printf("\r\n OK(WLAT)");
ryousato 3:d55ebd20d750 175 }
ryousato 3:d55ebd20d750 176
ryousato 3:d55ebd20d750 177 //CD74HC4051Eのイネーブル
ryousato 3:d55ebd20d750 178 void CS(int cs){
ryousato 3:d55ebd20d750 179 ENn = cs;
ryousato 3:d55ebd20d750 180 serial.printf("\r\n OK(CS)");
ryousato 3:d55ebd20d750 181 }
ryousato 3:d55ebd20d750 182
ryousato 3:d55ebd20d750 183 /******************************************************************************/
ryousato 3:d55ebd20d750 184 //CD74HC4051Eのアドレスセレクト
ryousato 3:d55ebd20d750 185 /******************************************************************************/
ryousato 3:d55ebd20d750 186 void ADDR(int addr){
ryousato 3:d55ebd20d750 187 ENn = 1; //CSをディセーブルにしておく
ryousato 3:d55ebd20d750 188 wait(0.02);
ryousato 3:d55ebd20d750 189 if(addr == 0){
ryousato 3:d55ebd20d750 190 addr0 = 0;
ryousato 3:d55ebd20d750 191 addr1 = 0;
ryousato 3:d55ebd20d750 192 addr2 = 0;
ryousato 3:d55ebd20d750 193 }
ryousato 3:d55ebd20d750 194 else if(addr == 1){
ryousato 3:d55ebd20d750 195 addr0 = 1;
ryousato 3:d55ebd20d750 196 addr1 = 0;
ryousato 3:d55ebd20d750 197 addr2 = 0;
ryousato 3:d55ebd20d750 198 }
ryousato 3:d55ebd20d750 199 else if(addr == 2){
ryousato 3:d55ebd20d750 200 addr0 = 0;
ryousato 3:d55ebd20d750 201 addr1 = 1;
ryousato 3:d55ebd20d750 202 addr2 = 0;
ryousato 3:d55ebd20d750 203 }
ryousato 3:d55ebd20d750 204 else if(addr == 3){
ryousato 3:d55ebd20d750 205 addr0 = 1;
ryousato 3:d55ebd20d750 206 addr1 = 1;
ryousato 3:d55ebd20d750 207 addr2 = 0;
ryousato 3:d55ebd20d750 208 }
ryousato 3:d55ebd20d750 209 else if(addr == 4){
ryousato 3:d55ebd20d750 210 addr0 = 0;
ryousato 3:d55ebd20d750 211 addr1 = 0;
ryousato 3:d55ebd20d750 212 addr2 = 1;
ryousato 3:d55ebd20d750 213 }
ryousato 3:d55ebd20d750 214 else if(addr == 5){
ryousato 3:d55ebd20d750 215 addr0 = 1;
ryousato 3:d55ebd20d750 216 addr1 = 0;
ryousato 3:d55ebd20d750 217 addr2 = 1;
ryousato 3:d55ebd20d750 218 }
ryousato 3:d55ebd20d750 219 else if(addr == 6){
ryousato 3:d55ebd20d750 220 addr0 = 0;
ryousato 3:d55ebd20d750 221 addr1 = 1;
ryousato 3:d55ebd20d750 222 addr2 = 1;
ryousato 3:d55ebd20d750 223 }
ryousato 3:d55ebd20d750 224 else if(addr == 7){
ryousato 3:d55ebd20d750 225 addr0 = 1;
ryousato 3:d55ebd20d750 226 addr1 = 1;
ryousato 3:d55ebd20d750 227 addr2 = 1;
ryousato 3:d55ebd20d750 228 }
ryousato 3:d55ebd20d750 229 wait(0.02);
ryousato 3:d55ebd20d750 230 ENn = 0; //イネーブル
ryousato 3:d55ebd20d750 231 wait(0.02);
ryousato 3:d55ebd20d750 232 //serial.printf("\r\n OK(ADDR%d)", addr);
ryousato 3:d55ebd20d750 233 }
ryousato 3:d55ebd20d750 234
ryousato 3:d55ebd20d750 235 /******************************************************************************/
ryousato 3:d55ebd20d750 236 //POT制御
ryousato 3:d55ebd20d750 237 //指定したPOTの現在値から、指定した量を増減する
ryousato 3:d55ebd20d750 238 /******************************************************************************/
ryousato 3:d55ebd20d750 239 void incdec(int incr, int val, int CorF, int mode){ //incr [0:1][-:+], val [0~255], CorF [2:1][C:F], mode [1:2:3][trans:ct1:ct2]
ryousato 3:d55ebd20d750 240 //現在の設定値読み取り
ryousato 3:d55ebd20d750 241 ADDR(mode * 2 + CorF -2);
ryousato 3:d55ebd20d750 242 int read_val = spi.write(0x0C00);
ryousato 3:d55ebd20d750 243 read_val &= 0x00FF;
ryousato 3:d55ebd20d750 244
ryousato 3:d55ebd20d750 245 //現在の設定値から増減値書き込み
ryousato 3:d55ebd20d750 246 int write_val;
ryousato 3:d55ebd20d750 247 if(incr == 1){write_val = read_val + val;}
ryousato 3:d55ebd20d750 248 else if(incr == 0){write_val = read_val - val;}
ryousato 3:d55ebd20d750 249 spi.write(write_val);
ryousato 3:d55ebd20d750 250
ryousato 3:d55ebd20d750 251 wait(0.001);
ryousato 3:d55ebd20d750 252
ryousato 3:d55ebd20d750 253 //粗、微　読み取り
ryousato 3:d55ebd20d750 254 ADDR(mode * 2); //TRANS粗調整POT
ryousato 3:d55ebd20d750 255 int read_val_Coarse = spi.write(0x0C00);
ryousato 3:d55ebd20d750 256 read_val_Coarse &= 0x00FF;
ryousato 3:d55ebd20d750 257
ryousato 3:d55ebd20d750 258 wait(0.001);
ryousato 3:d55ebd20d750 259
ryousato 3:d55ebd20d750 260 ADDR(mode * 2 - 1); //TRANS微調整POT
ryousato 3:d55ebd20d750 261 int read_val_Fine = spi.write(0x0C00);
ryousato 3:d55ebd20d750 262 read_val_Fine &= 0x00FF;
ryousato 3:d55ebd20d750 263
ryousato 3:d55ebd20d750 264 WLAT();
ryousato 3:d55ebd20d750 265
ryousato 3:d55ebd20d750 266 wait(0.001);
ryousato 3:d55ebd20d750 267
ryousato 3:d55ebd20d750 268 ENn = 1; //ディセーブル
ryousato 3:d55ebd20d750 269
ryousato 3:d55ebd20d750 270 serial.printf("\r\n Status --- Coarse[%d/255], Fine[%d/255] ---", read_val_Coarse, read_val_Fine);
ryousato 3:d55ebd20d750 271 }
ryousato 3:d55ebd20d750 272
ryousato 3:d55ebd20d750 273 /******************************************************************************/
ryousato 3:d55ebd20d750 274 //AD変換
ryousato 3:d55ebd20d750 275 //デバッグ用
ryousato 3:d55ebd20d750 276 /******************************************************************************/
ryousato 3:d55ebd20d750 277
ryousato 3:d55ebd20d750 278 void AD(int ad){
ryousato 3:d55ebd20d750 279 unsigned short AD_Val;
ryousato 3:d55ebd20d750 280 float AD_Val_f;
ryousato 3:d55ebd20d750 281 if(ad == 1){
ryousato 3:d55ebd20d750 282 AD_Val = (AD_TRANS_IN.read_u16() >> 6); //右シフト「>> 6」で10bit分解能に合わせる
ryousato 3:d55ebd20d750 283 AD_Val_f = AD_TRANS_IN.read();
ryousato 3:d55ebd20d750 284 }
ryousato 3:d55ebd20d750 285 else if(ad == 2){
ryousato 3:d55ebd20d750 286 AD_Val = (AD_CT_IN.read_u16() >> 6); //右シフト「>> 6」で10bit分解能に合わせる
ryousato 3:d55ebd20d750 287 AD_Val_f = AD_CT_IN.read();
ryousato 3:d55ebd20d750 288 }
ryousato 3:d55ebd20d750 289 wait(0.02);
ryousato 4:e69f73c66598 290 serial.printf("\r\nAD_Val : %1f [V] / (%d)d / (%x)h",(AD_Val*Vcc/1023),AD_Val,AD_Val);
ryousato 3:d55ebd20d750 291 serial.printf("\r\nAD_Val_f : %1f [V] / (%f)d",(AD_Val_f*Vcc),AD_Val_f);
ryousato 3:d55ebd20d750 292 }
ryousato 3:d55ebd20d750 293
ryousato 3:d55ebd20d750 294
ryousato 3:d55ebd20d750 295
ryousato 3:d55ebd20d750 296 void AD_CT(){
ryousato 3:d55ebd20d750 297 float AD_Val;
ryousato 3:d55ebd20d750 298 AD_Val = AD_TRANS_IN.read();
ryousato 3:d55ebd20d750 299 wait(0.02);
ryousato 3:d55ebd20d750 300 serial.printf("\r\n%1.3f",AD_Val);
ryousato 3:d55ebd20d750 301 }
ryousato 3:d55ebd20d750 302
ryousato 3:d55ebd20d750 303 /******************************************************************************/
ryousato 3:d55ebd20d750 304 //各POT初期設定
ryousato 3:d55ebd20d750 305 //mode 1:TRANS 2:CT1 3:CT2
ryousato 3:d55ebd20d750 306 /******************************************************************************/
ryousato 3:d55ebd20d750 307 void POTini(int mode){
ryousato 3:d55ebd20d750 308 ADDR(mode * 2); //TRANS粗調整POT
ryousato 3:d55ebd20d750 309 if(mode==1){spi.write(0x0076);}
ryousato 3:d55ebd20d750 310 else if(mode==2 || mode==3){spi.write(0x006B);}
ryousato 3:d55ebd20d750 311
ryousato 3:d55ebd20d750 312 wait(0.001);
ryousato 3:d55ebd20d750 313
ryousato 3:d55ebd20d750 314 ADDR(mode * 2 - 1); //TRANS微調整POT
ryousato 3:d55ebd20d750 315 spi.write(0x007F);
ryousato 3:d55ebd20d750 316
ryousato 3:d55ebd20d750 317 WLAT();
ryousato 3:d55ebd20d750 318
ryousato 3:d55ebd20d750 319 wait(0.001);
ryousato 3:d55ebd20d750 320
ryousato 3:d55ebd20d750 321 ENn = 1; //ディセーブル
ryousato 3:d55ebd20d750 322 }
ryousato 3:d55ebd20d750 323
ryousato 3:d55ebd20d750 324 /******************************************************************************/
ryousato 3:d55ebd20d750 325 //初期設定
ryousato 3:d55ebd20d750 326 //TRANS_OUT,CT1,2_OUTを初期値(50Hz,AC100V,60A相当)に調整
ryousato 3:d55ebd20d750 327 /******************************************************************************/
ryousato 3:d55ebd20d750 328 void initial(){
ryousato 3:d55ebd20d750 329 //全てのPOTの端子スイッチをONにする(TCON)
ryousato 3:d55ebd20d750 330 ADDR(1); //TRANS微調整POT
ryousato 3:d55ebd20d750 331 spi.write(0x40FF);
ryousato 3:d55ebd20d750 332 ADDR(2); //TRANS粗調整POT
ryousato 3:d55ebd20d750 333 spi.write(0x40FF);
ryousato 3:d55ebd20d750 334 ADDR(3); //CT1微調整POT
ryousato 3:d55ebd20d750 335 spi.write(0x40FF);
ryousato 3:d55ebd20d750 336 ADDR(4); //CT1粗調整POT
ryousato 3:d55ebd20d750 337 spi.write(0x40FF);
ryousato 3:d55ebd20d750 338 ADDR(5); //CT2微調整POT
ryousato 3:d55ebd20d750 339 spi.write(0x40FF);
ryousato 3:d55ebd20d750 340 ADDR(6); //CT2粗調整POT
ryousato 3:d55ebd20d750 341 spi.write(0x40FF);
ryousato 3:d55ebd20d750 342 wait(0.02);
ryousato 3:d55ebd20d750 343 ENn = 1; //CSをディセーブル
ryousato 3:d55ebd20d750 344
ryousato 3:d55ebd20d750 345 coilEN5 = 1; //±5V,±15VをON
ryousato 3:d55ebd20d750 346
ryousato 3:d55ebd20d750 347 coilEN1 = 0; //50Hz切替え
ryousato 3:d55ebd20d750 348
ryousato 3:d55ebd20d750 349 SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
ryousato 3:d55ebd20d750 350 SHDNn = 0; //電流帰還アンプ シャットダウンしない
ryousato 3:d55ebd20d750 351
ryousato 3:d55ebd20d750 352 //TRANS_OUT初期設定
ryousato 3:d55ebd20d750 353 coilEN2 = 0; //TRANS_OUTをAD入力方向へ切替え
ryousato 3:d55ebd20d750 354
ryousato 3:d55ebd20d750 355 ADDR(2); //TRANS粗調整POT
ryousato 3:d55ebd20d750 356 spi.write(0x0076);
ryousato 3:d55ebd20d750 357 read();
ryousato 3:d55ebd20d750 358 ADDR(1); //TRANS微調整POT
ryousato 3:d55ebd20d750 359 spi.write(0x007F);
ryousato 3:d55ebd20d750 360 read();
ryousato 3:d55ebd20d750 361 WLAT(); //設定したワイパーをラッチ
ryousato 3:d55ebd20d750 362 wait(0.02);
ryousato 3:d55ebd20d750 363 ENn = 1; //CSをディセーブル
ryousato 3:d55ebd20d750 364
ryousato 3:d55ebd20d750 365 //CT1_OUT初期設定
ryousato 3:d55ebd20d750 366 coilEN3 = 0; //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 367 coilEN4 = 0; //CT1を選択
ryousato 3:d55ebd20d750 368
ryousato 3:d55ebd20d750 369 ADDR(4); //CT1粗調整POT
ryousato 3:d55ebd20d750 370 spi.write(0x006B);
ryousato 3:d55ebd20d750 371 read();
ryousato 3:d55ebd20d750 372 ADDR(3); //CT1微調整POT
ryousato 3:d55ebd20d750 373 spi.write(0x007F);
ryousato 3:d55ebd20d750 374 read();
ryousato 3:d55ebd20d750 375 WLAT(); //設定したワイパーをラッチ
ryousato 3:d55ebd20d750 376 wait(0.02);
ryousato 3:d55ebd20d750 377 ENn = 1; //CSをディセーブル
ryousato 3:d55ebd20d750 378
ryousato 3:d55ebd20d750 379 //CT2_OUT初期設定
ryousato 3:d55ebd20d750 380 coilEN3 = 0; //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 381 coilEN4 = 1; //CT2を選択
ryousato 3:d55ebd20d750 382
ryousato 3:d55ebd20d750 383 POTini(3);
ryousato 3:d55ebd20d750 384 ADDR(6); //CT2粗調整POT
ryousato 3:d55ebd20d750 385 spi.write(0x006B);
ryousato 3:d55ebd20d750 386 read();
ryousato 3:d55ebd20d750 387 ADDR(5); //CT2微調整POT
ryousato 3:d55ebd20d750 388 spi.write(0x007F);
ryousato 3:d55ebd20d750 389 read();
ryousato 3:d55ebd20d750 390 WLAT(); //設定したワイパーをラッチ
ryousato 3:d55ebd20d750 391 wait(0.02);
ryousato 3:d55ebd20d750 392 ENn = 1; //CSをディセーブル
ryousato 3:d55ebd20d750 393
ryousato 3:d55ebd20d750 394 coilEN2 = 1; //TRANS_OUT出力
ryousato 3:d55ebd20d750 395 coilEN3 = 1; //CT1,2_OUT出力
ryousato 4:e69f73c66598 396 coilEN4 = 0;
ryousato 4:e69f73c66598 397
ryousato 4:e69f73c66598 398 /*
ryousato 3:d55ebd20d750 399 for(int i=0; i<10*2; i++){
ryousato 3:d55ebd20d750 400 led1 = !led1;
ryousato 2:5e6613f149d4 401 wait(0.1);
ryousato 3:d55ebd20d750 402 }
ryousato 3:d55ebd20d750 403 led1 = 0;
ryousato 4:e69f73c66598 404 */
ryousato 3:d55ebd20d750 405 serial.printf("\r\n OK(initial)");
ryousato 2:5e6613f149d4 406 }
ryousato 2:5e6613f149d4 407
ryousato 3:d55ebd20d750 408 /******************************************************************************/
ryousato 3:d55ebd20d750 409 //手動調整
ryousato 3:d55ebd20d750 410 /******************************************************************************/
ryousato 3:d55ebd20d750 411 void manual_adj(int mode){
ryousato 3:d55ebd20d750 412 if(mode == 2 || mode == 3){
ryousato 3:d55ebd20d750 413 serial.printf("\r\n Select range mode. Type '60A' or '120A'.");
ryousato 3:d55ebd20d750 414 while(1){
ryousato 3:d55ebd20d750 415 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 416 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 417 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 418
ryousato 3:d55ebd20d750 419 if(count == 5 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 420 moji[5] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 421 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 422 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 423 }
ryousato 3:d55ebd20d750 424
ryousato 3:d55ebd20d750 425 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 426
ryousato 3:d55ebd20d750 427 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 428 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 429 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 430 if (strcmp(moji, "60A") == 0){
ryousato 3:d55ebd20d750 431 SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
ryousato 3:d55ebd20d750 432 break;}
ryousato 3:d55ebd20d750 433 else if(strcmp(moji, "120A") == 0){
ryousato 3:d55ebd20d750 434 SCT_AMP = 1; //CT入力アンプ 120Aレベル切替え
ryousato 3:d55ebd20d750 435 break;}
ryousato 3:d55ebd20d750 436 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 437 }
ryousato 3:d55ebd20d750 438 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 439 }
ryousato 3:d55ebd20d750 440 }
ryousato 3:d55ebd20d750 441 serial.printf("\r\n OK");
ryousato 3:d55ebd20d750 442 }
ryousato 3:d55ebd20d750 443
ryousato 3:d55ebd20d750 444 /*
ryousato 3:d55ebd20d750 445 if(mode == 1){coilEN2 = 0;} //TRANS_OUTをAD入力方向へ切替え
ryousato 3:d55ebd20d750 446 else if(mode == 2){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 447 else if(mode == 3){coilEN3 = 0; coilEN4 = 1;} //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 448 */
ryousato 3:d55ebd20d750 449
ryousato 3:d55ebd20d750 450 //POTの状態を確認し、ステータス情報に表示する
ryousato 3:d55ebd20d750 451 ADDR(mode * 2); //TRANS粗調整POT
ryousato 3:d55ebd20d750 452 wait(0.2);
ryousato 3:d55ebd20d750 453 int read_val_Coarse = spi.write(0x0C00);
ryousato 3:d55ebd20d750 454 read_val_Coarse &= 0x00FF;
ryousato 3:d55ebd20d750 455
ryousato 3:d55ebd20d750 456 ADDR(mode * 2 - 1); //TRANS微調整POT
ryousato 3:d55ebd20d750 457 wait(0.2);
ryousato 3:d55ebd20d750 458 int read_val_Fine = spi.write(0x0C00);
ryousato 3:d55ebd20d750 459 read_val_Fine &= 0x00FF;
ryousato 3:d55ebd20d750 460 ENn = 1; //CSをディセーブル
ryousato 3:d55ebd20d750 461 serial.printf("\r\n\r\n Status --- Coarse[%d/255], Fine[%d/255] ---\r\n", read_val_Coarse, read_val_Fine);
ryousato 3:d55ebd20d750 462
ryousato 3:d55ebd20d750 463
ryousato 3:d55ebd20d750 464 //ループスタート
ryousato 3:d55ebd20d750 465 while(1){ //ループ1
ryousato 3:d55ebd20d750 466 serial.printf("\r\n Select mode '+-' or 'num'. ('q' quit)\r\n");
ryousato 3:d55ebd20d750 467 while(1){ //adjmode
ryousato 3:d55ebd20d750 468 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 469 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 470 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 471
ryousato 3:d55ebd20d750 472 if(count == 4 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 473 moji[4] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 474 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 475 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 476 }
ryousato 3:d55ebd20d750 477
ryousato 3:d55ebd20d750 478 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 479
ryousato 3:d55ebd20d750 480 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 481 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 482 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 483 if (strcmp(moji,"+-") == 0){
ryousato 3:d55ebd20d750 484 adjmode = 1;
ryousato 3:d55ebd20d750 485 break;}
ryousato 3:d55ebd20d750 486 else if(strcmp(moji,"num") == 0){
ryousato 3:d55ebd20d750 487 adjmode = 2;
ryousato 3:d55ebd20d750 488 break;}
ryousato 3:d55ebd20d750 489 else if(strcmp(moji,"q") == 0){break;}
ryousato 3:d55ebd20d750 490 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 491 }
ryousato 3:d55ebd20d750 492 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 493 }
ryousato 3:d55ebd20d750 494 } //adjmode
ryousato 3:d55ebd20d750 495
ryousato 3:d55ebd20d750 496 if(strcmp(moji,"q")==0){serial.printf("\r\n quit\r\n"); break;} //ループ1ブレイク
ryousato 3:d55ebd20d750 497
ryousato 3:d55ebd20d750 498 while(1){ //ループ2
ryousato 3:d55ebd20d750 499 serial.printf("\r\n Type 'C' for Coarse or 'F' for Fine. ('q' quit, 'b' back)\r\n");
ryousato 3:d55ebd20d750 500 while(1){ //CorF setting
ryousato 3:d55ebd20d750 501 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 502 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 503 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 504
ryousato 3:d55ebd20d750 505 if(count == 2 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 506 moji[2] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 507 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 508 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 509 }
ryousato 3:d55ebd20d750 510
ryousato 3:d55ebd20d750 511 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 512
ryousato 3:d55ebd20d750 513 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 514 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 515 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 516 if (strcmp(moji, "C") == 0){
ryousato 3:d55ebd20d750 517 CorF = 2; //粗調整
ryousato 3:d55ebd20d750 518 serial.printf("\r\n---Coarse Setting---");
ryousato 3:d55ebd20d750 519 break;}
ryousato 3:d55ebd20d750 520 else if(strcmp(moji, "F") == 0){
ryousato 3:d55ebd20d750 521 CorF = 1; //微調整
ryousato 3:d55ebd20d750 522 serial.printf("\r\n---Fine Setting---");
ryousato 3:d55ebd20d750 523 break;}
ryousato 3:d55ebd20d750 524 else if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
ryousato 3:d55ebd20d750 525 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 526 }
ryousato 3:d55ebd20d750 527 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 528 }
ryousato 3:d55ebd20d750 529 }//CorF setting
ryousato 3:d55ebd20d750 530
ryousato 3:d55ebd20d750 531 if(strcmp(moji,"b")==0){
ryousato 3:d55ebd20d750 532 serial.printf("\r\n return\r\n");
ryousato 3:d55ebd20d750 533 break; //ループ2ブレイク
ryousato 3:d55ebd20d750 534 }
ryousato 3:d55ebd20d750 535 else if(strcmp(moji,"q")==0){break;} //ループ2ブレイク
ryousato 3:d55ebd20d750 536
ryousato 3:d55ebd20d750 537 while(1){ //ループ3
ryousato 3:d55ebd20d750 538 if(adjmode == 1){
ryousato 3:d55ebd20d750 539 serial.printf("\r\n Type '+' for increment, '-' for decrement. ('q' quit, 'b' back)");
ryousato 3:d55ebd20d750 540 while(1){ //+-モード
ryousato 3:d55ebd20d750 541 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 542 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 543 serial.printf("\r\n%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 544 moji[1] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 545 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 546
ryousato 3:d55ebd20d750 547 if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
ryousato 3:d55ebd20d750 548 else if(strcmp(moji,"\n") == 0){}
ryousato 3:d55ebd20d750 549 else if(strcmp(moji,"+") == 0){incdec(1,1,CorF,mode);}
ryousato 3:d55ebd20d750 550 else if(strcmp(moji,"-") == 0){incdec(0,1,CorF,mode);}
ryousato 3:d55ebd20d750 551 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 552 }
ryousato 3:d55ebd20d750 553 } //+-モード
ryousato 3:d55ebd20d750 554 if(strcmp(moji,"b")==0){
ryousato 3:d55ebd20d750 555 serial.printf("\r\n return\r\n");
ryousato 3:d55ebd20d750 556 break; //ループ3ブレイク
ryousato 3:d55ebd20d750 557 }
ryousato 3:d55ebd20d750 558 else if(strcmp(moji,"q")==0){break;} //ループ3ブレイク
ryousato 3:d55ebd20d750 559 }
ryousato 3:d55ebd20d750 560 else if(adjmode == 2){
ryousato 3:d55ebd20d750 561 while(1){ //ループ4
ryousato 3:d55ebd20d750 562 serial.printf("\r\n Type '+' for increase, '-' for decrease. ('q' quit, 'b' back)");
ryousato 3:d55ebd20d750 563 while(1){ //numモード
ryousato 3:d55ebd20d750 564 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 565 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 566 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 567
ryousato 3:d55ebd20d750 568 if(count == 2 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 569 moji[2] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 570 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 571 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 572 }
ryousato 3:d55ebd20d750 573
ryousato 3:d55ebd20d750 574 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 575
ryousato 3:d55ebd20d750 576 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 577 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 578 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 579 if (strcmp(moji, "+") == 0){
ryousato 3:d55ebd20d750 580 incr = 1; //増加
ryousato 3:d55ebd20d750 581 serial.printf("\r\n---increase---");
ryousato 3:d55ebd20d750 582 break;}
ryousato 3:d55ebd20d750 583 else if(strcmp(moji, "-") == 0){
ryousato 3:d55ebd20d750 584 incr = 0; //減少
ryousato 3:d55ebd20d750 585 serial.printf("\r\n---decrease---");
ryousato 3:d55ebd20d750 586 break;}
ryousato 3:d55ebd20d750 587 else if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
ryousato 3:d55ebd20d750 588 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 589 }
ryousato 3:d55ebd20d750 590 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 591 }
ryousato 3:d55ebd20d750 592 } //numモード
ryousato 3:d55ebd20d750 593 if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;} //ループ4ブレイク
ryousato 3:d55ebd20d750 594 while(1){ //ループ5
ryousato 3:d55ebd20d750 595 serial.printf("\r\n Type number [0-255]. ('q' quit, 'b' back)");
ryousato 3:d55ebd20d750 596 for(int i=0; i<3; i++){moji[i] = '0';}
ryousato 3:d55ebd20d750 597
ryousato 3:d55ebd20d750 598 while(1){ //numモード2
ryousato 3:d55ebd20d750 599 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 600 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 601 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 602
ryousato 3:d55ebd20d750 603 if(count == 4 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 604 moji[4] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 605 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 606 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 607 }
ryousato 3:d55ebd20d750 608 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 609 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 610 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 611 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 612 if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
ryousato 3:d55ebd20d750 613 for(int i=0; i<3; i++){suuji[i] = 0;}
ryousato 3:d55ebd20d750 614 for(int i=0; i<3; i++){
ryousato 3:d55ebd20d750 615 suuji[i] = moji[i];
ryousato 3:d55ebd20d750 616 suuji[i] -= 48;
ryousato 3:d55ebd20d750 617 }
ryousato 3:d55ebd20d750 618 for(int i=0; i<3; i++){moji[i] = '0';}
ryousato 3:d55ebd20d750 619 if(suuji[0]>=0&&suuji[0]<=9){
ryousato 3:d55ebd20d750 620 if(suuji[1]>=0&&suuji[1]<=9){
ryousato 3:d55ebd20d750 621 if(suuji[2]>=0&&suuji[2]<=9){
ryousato 3:d55ebd20d750 622 suuji[0] *= 100;
ryousato 3:d55ebd20d750 623 suuji[1] *= 10;
ryousato 3:d55ebd20d750 624 }
ryousato 3:d55ebd20d750 625 else{
ryousato 3:d55ebd20d750 626 suuji[0] *= 10;
ryousato 3:d55ebd20d750 627 suuji[2] = 0;
ryousato 3:d55ebd20d750 628 }
ryousato 3:d55ebd20d750 629 }
ryousato 3:d55ebd20d750 630 else{
ryousato 3:d55ebd20d750 631 suuji[1] = 0;
ryousato 3:d55ebd20d750 632 suuji[2] = 0;
ryousato 3:d55ebd20d750 633 }
ryousato 3:d55ebd20d750 634 }
ryousato 3:d55ebd20d750 635 else{serial.printf("\r\n\r\n NG!\r\n"); break;}
ryousato 3:d55ebd20d750 636
ryousato 3:d55ebd20d750 637 wa = suuji[0]+suuji[1]+suuji[2];
ryousato 3:d55ebd20d750 638
ryousato 3:d55ebd20d750 639 incdec(incr,wa,CorF,mode);
ryousato 3:d55ebd20d750 640
ryousato 3:d55ebd20d750 641 }
ryousato 3:d55ebd20d750 642 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 643 }
ryousato 3:d55ebd20d750 644 } //numモード2
ryousato 3:d55ebd20d750 645 if(strcmp(moji,"b")==0){
ryousato 3:d55ebd20d750 646 serial.printf("\r\n return\r\n");
ryousato 3:d55ebd20d750 647 break; //ループ5ブレイク
ryousato 3:d55ebd20d750 648 }
ryousato 3:d55ebd20d750 649 else if(strcmp(moji,"q")==0){break;}
ryousato 3:d55ebd20d750 650 } //ループ5
ryousato 3:d55ebd20d750 651 if(strcmp(moji,"q")==0){break;} //ループ5→4ブレイク
ryousato 3:d55ebd20d750 652 } //ループ4
ryousato 3:d55ebd20d750 653 if(strcmp(moji,"b")==0){
ryousato 3:d55ebd20d750 654 serial.printf("\r\n return\r\n");
ryousato 3:d55ebd20d750 655 break; //ループ4→3ブレイク
ryousato 3:d55ebd20d750 656 }
ryousato 3:d55ebd20d750 657 else if(strcmp(moji,"q")==0){break;} //ループ4→3ブレイク
ryousato 3:d55ebd20d750 658 } //if文
ryousato 3:d55ebd20d750 659 } //ループ3
ryousato 3:d55ebd20d750 660 if(strcmp(moji,"q")==0){break;} //ループ3→2ブレイク
ryousato 3:d55ebd20d750 661 } //ループ2
ryousato 3:d55ebd20d750 662 if(strcmp(moji,"q")==0){
ryousato 3:d55ebd20d750 663 serial.printf("\r\n quit\r\n");
ryousato 3:d55ebd20d750 664 break; //ループ2→1ブレイク
ryousato 3:d55ebd20d750 665 }
ryousato 3:d55ebd20d750 666 } //ループ１
ryousato 3:d55ebd20d750 667
ryousato 3:d55ebd20d750 668 serial.printf("\r\n MANUAL_ADJ END");
ryousato 3:d55ebd20d750 669 }
ryousato 3:d55ebd20d750 670
ryousato 3:d55ebd20d750 671 /******************************************************************************/
ryousato 3:d55ebd20d750 672 //タイマー割込み https://monoist.atmarkit.co.jp/mn/articles/1506/19/news001_2.html
ryousato 3:d55ebd20d750 673 /******************************************************************************/
ryousato 3:d55ebd20d750 674 /*
ryousato 3:d55ebd20d750 675 void attime(){
ryousato 3:d55ebd20d750 676 led1 = !led1;
ryousato 3:d55ebd20d750 677 }
ryousato 3:d55ebd20d750 678 */
ryousato 3:d55ebd20d750 679 /******************************************************************************/
ryousato 3:d55ebd20d750 680 //タイマー割込み
ryousato 3:d55ebd20d750 681 //オフセット補正したActualVrefを求める (平均値を出しているだけ)
ryousato 3:d55ebd20d750 682 /******************************************************************************/
ryousato 3:d55ebd20d750 683 void AVrefcal(){
ryousato 3:d55ebd20d750 684 led1 = !led1;
ryousato 3:d55ebd20d750 685
ryousato 3:d55ebd20d750 686 if(mode_p == 1){AD_val = AD_TRANS_IN.read();}
ryousato 3:d55ebd20d750 687 else if(mode_p==2 || mode_p==3){AD_val = AD_CT_IN.read();}
ryousato 3:d55ebd20d750 688
ryousato 3:d55ebd20d750 689 AD_val = AD_val * Vcc; //(val)
ryousato 3:d55ebd20d750 690 AD_flag = 1;
ryousato 3:d55ebd20d750 691
ryousato 3:d55ebd20d750 692 //serial.printf("\r\n AD_val = %f",AD_val);
ryousato 2:5e6613f149d4 693 }
ryousato 2:5e6613f149d4 694
ryousato 3:d55ebd20d750 695 ////////////////////////////
ryousato 3:d55ebd20d750 696 //サンプリング ActualVref
ryousato 3:d55ebd20d750 697 //mode 1:TRANS 2:CT1 3:CT2
ryousato 3:d55ebd20d750 698 ////////////////////////////
ryousato 3:d55ebd20d750 699 void offsetcal(int mode){
ryousato 3:d55ebd20d750 700 AD_count = 0;
ryousato 3:d55ebd20d750 701 AD_flag = 0;
ryousato 3:d55ebd20d750 702 AD_val = 0;
ryousato 3:d55ebd20d750 703 AD_val_sum = 0;
ryousato 3:d55ebd20d750 704
ryousato 3:d55ebd20d750 705 mode_p = mode;
ryousato 3:d55ebd20d750 706 if(mode == 1){coilEN2 = 0;} //TRANS_OUTをAD入力方向へ切替え
ryousato 3:d55ebd20d750 707 else if(mode == 2){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 708 else if(mode == 3){coilEN3 = 0; coilEN4 = 1;} //CT1_OUT1と2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 709
ryousato 3:d55ebd20d750 710 wait(0.05);
ryousato 3:d55ebd20d750 711
ryousato 3:d55ebd20d750 712 timerint.attach(&AVrefcal,0.020408);
ryousato 3:d55ebd20d750 713
ryousato 3:d55ebd20d750 714 timecount.start();
ryousato 3:d55ebd20d750 715
ryousato 3:d55ebd20d750 716 while(1){
ryousato 3:d55ebd20d750 717 if(AD_count < 98 && AD_flag == 1){ //サンプリング数0~Nで、サンプル取得されたとき
ryousato 3:d55ebd20d750 718 AD_count ++;
ryousato 3:d55ebd20d750 719 AD_val_sum += AD_val;
ryousato 3:d55ebd20d750 720 AD_flag = 0;
ryousato 3:d55ebd20d750 721 if(AD_count == 0){timecount.start();} //0~Nのサンプリング時間計測用スタート時
ryousato 3:d55ebd20d750 722 else if(AD_count == 98){ //0~Nのサンプリング時間計測用ストップ時
ryousato 3:d55ebd20d750 723 timecount.stop();
ryousato 3:d55ebd20d750 724 //serial.printf("\r\n t = %f",timecount.read());
ryousato 3:d55ebd20d750 725 timecount.reset();
ryousato 3:d55ebd20d750 726 }
ryousato 3:d55ebd20d750 727 }
ryousato 3:d55ebd20d750 728 else if(AD_count < 98 && AD_flag == 0){} //サンプリング数0~Nで、サンプル取得されてないとき
ryousato 3:d55ebd20d750 729 else{ //サンプリング完了時
ryousato 3:d55ebd20d750 730 Vref = AD_val_sum / AD_count;
ryousato 3:d55ebd20d750 731 ActualVref[mode_p] = Vref; //格納
ryousato 4:e69f73c66598 732 serial.printf("\r\n Vref%d = %f",mode_p,ActualVref[mode_p]);
ryousato 3:d55ebd20d750 733 break;
ryousato 3:d55ebd20d750 734 }
ryousato 3:d55ebd20d750 735 }
ryousato 3:d55ebd20d750 736 timerint.detach();
ryousato 3:d55ebd20d750 737 led1 = 0;
ryousato 3:d55ebd20d750 738 }
ryousato 3:d55ebd20d750 739
ryousato 4:e69f73c66598 740 void dispVref(){
ryousato 4:e69f73c66598 741 serial.printf("\r\n TRANS_Vref = %f",ActualVref[1]);
ryousato 4:e69f73c66598 742 serial.printf("\r\n CT1___Vref = %f",ActualVref[2]);
ryousato 4:e69f73c66598 743 serial.printf("\r\n CT2___Vref = %f",ActualVref[3]);
ryousato 3:d55ebd20d750 744 }
ryousato 3:d55ebd20d750 745 /******************************************************************************/
ryousato 3:d55ebd20d750 746 //タイマー割込み
ryousato 3:d55ebd20d750 747 //AD変換によりVrmsを求める
ryousato 3:d55ebd20d750 748 /******************************************************************************/
ryousato 3:d55ebd20d750 749 //タイマー割込み実行関数
ryousato 3:d55ebd20d750 750 void timerAD(){
ryousato 3:d55ebd20d750 751 led1 = !led1;
ryousato 4:e69f73c66598 752 //serial.printf("\r\n mode_p = %d",mode_p);
ryousato 4:e69f73c66598 753 //serial.printf("\r\n ActualVref = %f",ActualVref[mode_p]);
ryousato 3:d55ebd20d750 754
ryousato 3:d55ebd20d750 755 if(mode_p == 1){AD_val = AD_TRANS_IN.read();}
ryousato 3:d55ebd20d750 756 else if(mode_p==2 || mode_p==3){AD_val = AD_CT_IN.read();}
ryousato 3:d55ebd20d750 757
ryousato 3:d55ebd20d750 758 //serial.printf("\r\n AD_val = %f",AD_val);
ryousato 3:d55ebd20d750 759
ryousato 3:d55ebd20d750 760 AD_val *= Vcc;
ryousato 3:d55ebd20d750 761 AD_val -= ActualVref[mode_p];
ryousato 3:d55ebd20d750 762 //serial.printf("\r\n AD_val*Vcc-Vref = %f",AD_val);
ryousato 3:d55ebd20d750 763 AD_val *= AD_val;
ryousato 3:d55ebd20d750 764 AD_flag = 1;
ryousato 3:d55ebd20d750 765
ryousato 3:d55ebd20d750 766 //serial.printf("\r\n AD_val = %f",AD_val);
ryousato 3:d55ebd20d750 767 }
ryousato 3:d55ebd20d750 768 ////////////////////////////
ryousato 3:d55ebd20d750 769 //サンプリング Vrms
ryousato 3:d55ebd20d750 770 //mode 1:TRANS 2:CT1 3:CT2
ryousato 3:d55ebd20d750 771 ////////////////////////////
ryousato 3:d55ebd20d750 772 void ADVrms(int mode){
ryousato 3:d55ebd20d750 773 AD_count = 0;
ryousato 3:d55ebd20d750 774 AD_flag = 0;
ryousato 3:d55ebd20d750 775 AD_val = 0;
ryousato 3:d55ebd20d750 776 AD_val_sum = 0;
ryousato 3:d55ebd20d750 777
ryousato 3:d55ebd20d750 778 mode_p = mode;
ryousato 3:d55ebd20d750 779 if(mode == 1){coilEN2 = 0;} //TRANS_OUTをAD入力方向へ切替え
ryousato 3:d55ebd20d750 780 else if(mode == 2){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1をAD入力方向へ切替え
ryousato 3:d55ebd20d750 781 else if(mode == 3){coilEN3 = 0; coilEN4 = 1;} //CT1_OUT2をAD入力方向へ切替え
ryousato 3:d55ebd20d750 782
ryousato 3:d55ebd20d750 783 wait(0.05);
ryousato 3:d55ebd20d750 784
ryousato 3:d55ebd20d750 785 timerint.attach(&timerAD,0.020408);
ryousato 3:d55ebd20d750 786
ryousato 3:d55ebd20d750 787 timecount.start();
ryousato 3:d55ebd20d750 788
ryousato 3:d55ebd20d750 789 while(1){
ryousato 3:d55ebd20d750 790 if(AD_count < 49 && AD_flag == 1){ //サンプリング数0~Nで、サンプル取得されたとき
ryousato 3:d55ebd20d750 791 AD_count ++;
ryousato 3:d55ebd20d750 792 AD_val_sum += AD_val;
ryousato 3:d55ebd20d750 793 AD_flag = 0;
ryousato 3:d55ebd20d750 794 if(AD_count == 0){timecount.start();} //0~Nのサンプリング時間計測用スタート時
ryousato 3:d55ebd20d750 795 else if(AD_count == 49){ //0~Nのサンプリング時間計測用ストップ時
ryousato 3:d55ebd20d750 796 timecount.stop();
ryousato 3:d55ebd20d750 797 //serial.printf("\r\n t = %f",timecount.read());
ryousato 3:d55ebd20d750 798 timecount.reset();
ryousato 3:d55ebd20d750 799 }
ryousato 3:d55ebd20d750 800 }
ryousato 3:d55ebd20d750 801 else if(AD_count < 49 && AD_flag == 0){}//サンプリング数0~Nで、サンプル取得されてないとき
ryousato 3:d55ebd20d750 802 else{ //サンプリング完了時
ryousato 3:d55ebd20d750 803 AD_val_sum /= AD_count;
ryousato 3:d55ebd20d750 804 Vrms = sqrtf(AD_val_sum);
ryousato 3:d55ebd20d750 805 //serial.printf("\r\n AD_val_sum = %f",AD_val_sum);
ryousato 3:d55ebd20d750 806 serial.printf("\r\n Vrms = %f",Vrms);
ryousato 3:d55ebd20d750 807 break;
ryousato 3:d55ebd20d750 808 }
ryousato 3:d55ebd20d750 809 }
ryousato 3:d55ebd20d750 810 timerint.detach();
ryousato 3:d55ebd20d750 811 led1 = 0;
ryousato 2:5e6613f149d4 812 }
ryousato 2:5e6613f149d4 813
ryousato 3:d55ebd20d750 814 //デバッグ用
ryousato 3:d55ebd20d750 815 void att(int mode){
ryousato 3:d55ebd20d750 816 mode_p = mode;
ryousato 3:d55ebd20d750 817 timerint.attach(&timerAD,0.020408); //サンプリング数=49 20.4ms周期
ryousato 3:d55ebd20d750 818 }
ryousato 3:d55ebd20d750 819 void det(){timerint.detach();}
ryousato 3:d55ebd20d750 820
ryousato 3:d55ebd20d750 821 /******************************************************************************/
ryousato 3:d55ebd20d750 822 //自動調整
ryousato 3:d55ebd20d750 823 //TRANS_OUT設定範囲 : AC 50~138V
ryousato 3:d55ebd20d750 824 //CT1,2_OUT設定範囲 : AC 10~120A
ryousato 3:d55ebd20d750 825 /******************************************************************************/
ryousato 3:d55ebd20d750 826 void auto_adj(int mode){
ryousato 3:d55ebd20d750 827
ryousato 3:d55ebd20d750 828 ///////////////////////////////////////////////////////////////////////////////
ryousato 3:d55ebd20d750 829 POTini(mode); //POTを初期値に設定
ryousato 3:d55ebd20d750 830 ///////////////////////////////////////////////////////////////////////////////
ryousato 3:d55ebd20d750 831
ryousato 3:d55ebd20d750 832 //'60A' or '120A'
ryousato 3:d55ebd20d750 833 if(mode == 2 || mode == 3){
ryousato 3:d55ebd20d750 834 serial.printf("\r\n Select range mode. Type '60A' or '120A'.");
ryousato 3:d55ebd20d750 835 while(1){
ryousato 3:d55ebd20d750 836 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 837 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 838 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 839
ryousato 3:d55ebd20d750 840 if(count == 5 ){ // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 841 moji[5] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 842 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 843 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 844 }
ryousato 3:d55ebd20d750 845
ryousato 3:d55ebd20d750 846 else if(moji[0] == '\n'){count = 0;}
ryousato 3:d55ebd20d750 847
ryousato 3:d55ebd20d750 848 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 849 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 850 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 851 if (strcmp(moji, "60A") == 0){
ryousato 3:d55ebd20d750 852 SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
ryousato 3:d55ebd20d750 853 break;}
ryousato 3:d55ebd20d750 854 else if(strcmp(moji, "120A") == 0){
ryousato 3:d55ebd20d750 855 SCT_AMP = 1; //CT入力アンプ 120Aレベル切替え
ryousato 3:d55ebd20d750 856 break;}
ryousato 3:d55ebd20d750 857 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 858 }
ryousato 3:d55ebd20d750 859 else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 860 }
ryousato 3:d55ebd20d750 861 }
ryousato 3:d55ebd20d750 862 serial.printf("\r\n OK");
ryousato 3:d55ebd20d750 863 } //'60A' or '120A'
ryousato 3:d55ebd20d750 864
ryousato 3:d55ebd20d750 865 while(1) { //ループ1
ryousato 3:d55ebd20d750 866 int adjnum = 0;
ryousato 3:d55ebd20d750 867
ryousato 3:d55ebd20d750 868 //シリアル表示
ryousato 3:d55ebd20d750 869 if(mode == 1) {
ryousato 3:d55ebd20d750 870 serial.printf("\r\n Type number AC [50-138] V. ('q' quit)");
ryousato 3:d55ebd20d750 871 } else if(mode==2 || mode==3) {
ryousato 3:d55ebd20d750 872 serial.printf("\r\n Type number AC [10-120] A. ('q' quit)\r\n (If 61~120A, range mode change 120A automatically.)");
ryousato 3:d55ebd20d750 873 }
ryousato 3:d55ebd20d750 874
ryousato 3:d55ebd20d750 875 for(int i=0; i<3; i++) {
ryousato 3:d55ebd20d750 876 moji[i] = '0'; //mojiを初期化
ryousato 3:d55ebd20d750 877 }
ryousato 3:d55ebd20d750 878
ryousato 3:d55ebd20d750 879 while(1) { //adjnumループ
ryousato 3:d55ebd20d750 880 if(serial.readable()) { // 受信確認
ryousato 3:d55ebd20d750 881 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 882 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 883
ryousato 3:d55ebd20d750 884 if(count == 4 ) { // ①文字数が既定の個数になった場合
ryousato 3:d55ebd20d750 885 moji[4] = '\0'; // 末尾に終端文字を入れる
ryousato 3:d55ebd20d750 886 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 887 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 888 } else if(moji[0] == '\n') {
ryousato 3:d55ebd20d750 889 count = 0;
ryousato 3:d55ebd20d750 890 } else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 891 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 892 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 893 if(strcmp(moji,"q")==0) {
ryousato 3:d55ebd20d750 894 break;
ryousato 3:d55ebd20d750 895 }
ryousato 3:d55ebd20d750 896 for(int i=0; i<3; i++) {
ryousato 3:d55ebd20d750 897 suuji[i] = 0; //suujiを初期化
ryousato 3:d55ebd20d750 898 }
ryousato 3:d55ebd20d750 899 for(int i=0; i<3; i++) {
ryousato 3:d55ebd20d750 900 suuji[i] = moji[i];
ryousato 3:d55ebd20d750 901 suuji[i] -= 48; //ASCII → 10進
ryousato 3:d55ebd20d750 902 }
ryousato 3:d55ebd20d750 903 for(int i=0; i<3; i++) {
ryousato 3:d55ebd20d750 904 moji[i] = '0'; //mojiを初期化
ryousato 3:d55ebd20d750 905 }
ryousato 3:d55ebd20d750 906
ryousato 3:d55ebd20d750 907 //数字であるか判定
ryousato 3:d55ebd20d750 908 if(suuji[0]>=0 && suuji[0]<=9) {
ryousato 3:d55ebd20d750 909 if(suuji[1]>=0&&suuji[1]<=9) {
ryousato 3:d55ebd20d750 910 if(suuji[2]>=0&&suuji[2]<=9) {
ryousato 3:d55ebd20d750 911 suuji[0] *= 100;
ryousato 3:d55ebd20d750 912 suuji[1] *= 10;
ryousato 3:d55ebd20d750 913 } else {
ryousato 3:d55ebd20d750 914 suuji[0] *= 10;
ryousato 3:d55ebd20d750 915 suuji[2] = 0;
ryousato 3:d55ebd20d750 916 }
ryousato 3:d55ebd20d750 917 } else {
ryousato 3:d55ebd20d750 918 suuji[1] = 0;
ryousato 3:d55ebd20d750 919 suuji[2] = 0;
ryousato 3:d55ebd20d750 920 }
ryousato 3:d55ebd20d750 921 } else {
ryousato 3:d55ebd20d750 922 serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 923 adjnum = 1;
ryousato 3:d55ebd20d750 924 break; //adjnumループ ブレイク
ryousato 3:d55ebd20d750 925 }
ryousato 3:d55ebd20d750 926
ryousato 3:d55ebd20d750 927 setval = suuji[0]+suuji[1]+suuji[2];
ryousato 3:d55ebd20d750 928
ryousato 3:d55ebd20d750 929 //設定範囲判定 と Vrms換算
ryousato 3:d55ebd20d750 930 if(mode == 1){
ryousato 3:d55ebd20d750 931 if(setval >= 50 && setval <= 138){
ryousato 3:d55ebd20d750 932 setval = setval * 0.12 * 0.196078; //0.12:トランス比 0.196078:分圧抵抗比
ryousato 3:d55ebd20d750 933 //serial.printf("\r\n %f",setval);
ryousato 3:d55ebd20d750 934 setval /= 2;
ryousato 3:d55ebd20d750 935 setval /= sqrtf(2);
ryousato 3:d55ebd20d750 936 serial.printf("\r\n setval = %f",setval);
ryousato 3:d55ebd20d750 937 break; //adjnumループ ブレイク
ryousato 3:d55ebd20d750 938 }
ryousato 3:d55ebd20d750 939 else{
ryousato 3:d55ebd20d750 940 serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 941 adjnum = 1;
ryousato 3:d55ebd20d750 942 break; //adjnumループ ブレイク
ryousato 3:d55ebd20d750 943 }
ryousato 3:d55ebd20d750 944 }
ryousato 3:d55ebd20d750 945 else if(mode==2 || mode==3){
ryousato 3:d55ebd20d750 946 if(setval >= 10 && setval <= 120){
ryousato 3:d55ebd20d750 947 setval = setval / 3000 * 10 * 5.666667; //3000:CT比 10:終端抵抗 5.666667:分圧抵抗比
ryousato 3:d55ebd20d750 948 serial.printf("\r\n setval = %f",setval);
ryousato 3:d55ebd20d750 949 if(setval >= 61 && setval <= 120){SCT_AMP = 1;}
ryousato 3:d55ebd20d750 950 break; //adjnumループ ブレイク
ryousato 3:d55ebd20d750 951 }
ryousato 3:d55ebd20d750 952 else{
ryousato 3:d55ebd20d750 953 serial.printf("\r\n\r\n NG!\r\n");
ryousato 3:d55ebd20d750 954 adjnum = 1;
ryousato 3:d55ebd20d750 955 break; //adjnumループ ブレイク
ryousato 3:d55ebd20d750 956 }
ryousato 3:d55ebd20d750 957 }
ryousato 3:d55ebd20d750 958 } else count++; // 文字カウンタに1加算
ryousato 3:d55ebd20d750 959 } //if
ryousato 3:d55ebd20d750 960 } //adjnumループ
ryousato 3:d55ebd20d750 961 if(adjnum==0 || strcmp(moji,"q")==0){break;} //ループ1ブレイク
ryousato 3:d55ebd20d750 962 } //ループ1
ryousato 3:d55ebd20d750 963
ryousato 3:d55ebd20d750 964 int adjcount = 0; //ループ2上限変数
ryousato 3:d55ebd20d750 965
ryousato 3:d55ebd20d750 966 while(1){ //ループ2
ryousato 3:d55ebd20d750 967 if(strcmp(moji,"q")==0){
ryousato 3:d55ebd20d750 968 serial.printf("\r\n quit");
ryousato 3:d55ebd20d750 969 break; //ループ2ブレイク
ryousato 3:d55ebd20d750 970 }
ryousato 4:e69f73c66598 971 else if(adjcount >= 15){ //ループ2上限値
ryousato 3:d55ebd20d750 972 serial.printf("\r\n\r\n ERROR!\r\n");
ryousato 3:d55ebd20d750 973 break; //ループ2ブレイク
ryousato 3:d55ebd20d750 974 }
ryousato 3:d55ebd20d750 975
ryousato 3:d55ebd20d750 976 ADVrms(mode); //現在のVrms値
ryousato 3:d55ebd20d750 977
ryousato 3:d55ebd20d750 978 diff = setval - Vrms; //差分
ryousato 3:d55ebd20d750 979 //serial.printf("\r\n diff = %f",diff);
ryousato 3:d55ebd20d750 980
ryousato 3:d55ebd20d750 981 //増減方向判定
ryousato 3:d55ebd20d750 982 if(diff > 0){incr = 1;} //増
ryousato 3:d55ebd20d750 983 else if(diff < 0){
ryousato 3:d55ebd20d750 984 incr = 0; //減
ryousato 3:d55ebd20d750 985 diff *= -1; //絶対値
ryousato 3:d55ebd20d750 986 }
ryousato 3:d55ebd20d750 987 else if(diff == 0){break;} //差分無し ループ2ブレイク
ryousato 3:d55ebd20d750 988 serial.printf("\r\n diff = %f",diff);
ryousato 3:d55ebd20d750 989 serial.printf("\r\n incr = %d",incr);
ryousato 3:d55ebd20d750 990
ryousato 3:d55ebd20d750 991 //粗・微 調整判定
ryousato 3:d55ebd20d750 992 if(diff >= 0.03){CorF = 2;} //粗
ryousato 3:d55ebd20d750 993 else if(diff < 0.03){
ryousato 3:d55ebd20d750 994 CorF = 1; //微
ryousato 3:d55ebd20d750 995 if(diff < 0.002){break;}//差分微小 ループ2ブレイク(通常最終ゴール)
ryousato 3:d55ebd20d750 996 }
ryousato 3:d55ebd20d750 997 serial.printf("\r\n CorF = %d",CorF);
ryousato 3:d55ebd20d750 998
ryousato 3:d55ebd20d750 999 //調整tap値算出
ryousato 3:d55ebd20d750 1000 if(CorF == 2){val = diff / 0.02;}
ryousato 3:d55ebd20d750 1001 else if(CorF == 1){val = diff / 0.002;}
ryousato 3:d55ebd20d750 1002 serial.printf("\r\n tap(val) = %d",val);
ryousato 3:d55ebd20d750 1003
ryousato 3:d55ebd20d750 1004 //ワイパー位置移動
ryousato 3:d55ebd20d750 1005 incdec(incr, val, CorF, mode);
ryousato 3:d55ebd20d750 1006
ryousato 3:d55ebd20d750 1007 adjcount ++;
ryousato 3:d55ebd20d750 1008
ryousato 3:d55ebd20d750 1009 } //ループ2
ryousato 3:d55ebd20d750 1010
ryousato 3:d55ebd20d750 1011 if(mode==1){coilEN2 = 0;} //TRANS_OUTを外部出力へ切替え
ryousato 3:d55ebd20d750 1012 else if(mode==2 || mode==3){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1と2を外部出力へ切替え
ryousato 3:d55ebd20d750 1013
ryousato 3:d55ebd20d750 1014 serial.printf("\r\n ADJ END");
ryousato 3:d55ebd20d750 1015 }
ryousato 3:d55ebd20d750 1016
ryousato 4:e69f73c66598 1017 void Vswitch(int a){
ryousato 4:e69f73c66598 1018 coilEN5 = a;
ryousato 4:e69f73c66598 1019 serial.printf("\r\n OK");
ryousato 4:e69f73c66598 1020 }
ryousato 4:e69f73c66598 1021 void Fswitch(int a){
ryousato 4:e69f73c66598 1022 coilEN1 = a;
ryousato 4:e69f73c66598 1023 serial.printf("\r\n OK");
ryousato 4:e69f73c66598 1024 }
ryousato 4:e69f73c66598 1025 void Tswitch(int a){
ryousato 4:e69f73c66598 1026 coilEN2 = a;
ryousato 4:e69f73c66598 1027 serial.printf("\r\n OK");
ryousato 4:e69f73c66598 1028 }
ryousato 4:e69f73c66598 1029 void Cswitch(int a,int b){
ryousato 4:e69f73c66598 1030 coilEN3 = a;
ryousato 4:e69f73c66598 1031 coilEN4 = b;
ryousato 4:e69f73c66598 1032 serial.printf("\r\n OK");
ryousato 4:e69f73c66598 1033 }
ryousato 4:e69f73c66598 1034
ryousato 3:d55ebd20d750 1035 /******************************************************************************/
ryousato 3:d55ebd20d750 1036 //シリアル入力受付 [メイン]
ryousato 3:d55ebd20d750 1037 /******************************************************************************/
ryousato 0:df1e1f84ded8 1038 void serial_inout(){
ryousato 0:df1e1f84ded8 1039 if(serial.readable()) { // 受信確認
ryousato 0:df1e1f84ded8 1040 moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
ryousato 3:d55ebd20d750 1041 serial.printf("%c", moji[count]); //シリアル出力表示
ryousato 3:d55ebd20d750 1042 // serial.printf("%c(%d)", moji[count],count); //シリアル出力表示
ryousato 0:df1e1f84ded8 1043
ryousato 0:df1e1f84ded8 1044 if(count == 31 ){ // ①文字数が既定の個数になった場合
ryousato 0:df1e1f84ded8 1045 moji[31] = '\0'; // 末尾に終端文字を入れる
ryousato 0:df1e1f84ded8 1046 count = 0; // 文字カウンタをリセット
ryousato 3:d55ebd20d750 1047 serial.printf("\r\n\r\n ERROR!");
ryousato 0:df1e1f84ded8 1048 }
ryousato 0:df1e1f84ded8 1049
ryousato 1:88f0bc1e1aff 1050 else if(moji[0] == '\n'){count = 0;}
ryousato 0:df1e1f84ded8 1051
ryousato 0:df1e1f84ded8 1052 else if((moji[count] == '\r')) { // ②CRを受信した場合
ryousato 3:d55ebd20d750 1053 moji[count] = '\0'; //末尾に終端文字を入れる
ryousato 3:d55ebd20d750 1054 count = 0; //文字カウンタをリセット
ryousato 3:d55ebd20d750 1055 if (strcmp(moji, "cmd") == 0){helpwrite();} //コマンド一覧表示
ryousato 3:d55ebd20d750 1056 else if(strcmp(moji, "help") == 0){helpwrite();} //コマンド一覧表示
ryousato 3:d55ebd20d750 1057 else if(strcmp(moji, "?") == 0){helpwrite();} //コマンド一覧表示
ryousato 3:d55ebd20d750 1058 else if(strcmp(moji, "initial") == 0){initial();} //初期化
ryousato 4:e69f73c66598 1059
ryousato 4:e69f73c66598 1060 else if(strcmp(moji, "V_OFF") == 0){Vswitch(0);} //±5V,±15Vオフ
ryousato 4:e69f73c66598 1061 else if(strcmp(moji, "V_ON") == 0){Vswitch(1);} //±5V,±15Vオン
ryousato 4:e69f73c66598 1062 else if(strcmp(moji, "50Hz") == 0){Fswitch(0);} //周波数切替
ryousato 4:e69f73c66598 1063 else if(strcmp(moji, "60Hz") == 0){Fswitch(1);} //周波数切替
ryousato 4:e69f73c66598 1064 else if(strcmp(moji, "TRANS_OUT_ADINT") == 0){Tswitch(0);} //TRANS_OUT内部AD入力
ryousato 4:e69f73c66598 1065 else if(strcmp(moji, "TRANS_OUT_EXT") == 0){Tswitch(1);} //TRANS_OUT外部出力
ryousato 4:e69f73c66598 1066 else if(strcmp(moji, "CT1_OUT_ADINT") == 0){Cswitch(0,0);} //CT1_OUT内部AD入力
ryousato 4:e69f73c66598 1067 else if(strcmp(moji, "CT2_OUT_ADINT") == 0){Cswitch(0,1);} //CT2_OUT内部AD入力
ryousato 4:e69f73c66598 1068 else if(strcmp(moji, "CT_OUT_EXT") == 0){Cswitch(1,0);} //CT1,2_OUT外部出力
ryousato 4:e69f73c66598 1069
ryousato 4:e69f73c66598 1070 else if(strcmp(moji, "TRANS_offset") == 0){offsetcal(1);} //TRANS_OUT ADオフセット補正
ryousato 4:e69f73c66598 1071 else if(strcmp(moji, "CT1_offset") == 0){offsetcal(2);} //CT1_OUT ADオフセット補正
ryousato 4:e69f73c66598 1072 else if(strcmp(moji, "CT2_offset") == 0){offsetcal(3);} //CT2_OUT ADオフセット補正
ryousato 4:e69f73c66598 1073 else if(strcmp(moji, "dispVref") == 0){dispVref();} //各Vref表示
ryousato 3:d55ebd20d750 1074 else if(strcmp(moji, "TRANS_ADJ") == 0){auto_adj(1);} //TRANS_OUT調整モードに移行
ryousato 3:d55ebd20d750 1075 else if(strcmp(moji, "CT1_ADJ") == 0){auto_adj(2);} //CT1_OUT調整モードに移行
ryousato 3:d55ebd20d750 1076 else if(strcmp(moji, "CT2_ADJ") == 0){auto_adj(3);} //CT2_OUT調整モードに移行
ryousato 3:d55ebd20d750 1077 else if(strcmp(moji, "MANUAL_TRANS_ADJ") == 0){manual_adj(1);} //TRANS_OUT手動調整モードに移行
ryousato 3:d55ebd20d750 1078 else if(strcmp(moji, "MANUAL_CT1_ADJ") == 0){manual_adj(2);} //CT1_OUT手動調整モードに移行
ryousato 3:d55ebd20d750 1079 else if(strcmp(moji, "MANUAL_CT2_ADJ") == 0){manual_adj(3);} //CT1_OU2手動調整モードに移行
ryousato 3:d55ebd20d750 1080
ryousato 3:d55ebd20d750 1081 //デバッグ用
ryousato 2:5e6613f149d4 1082 else if(strcmp(moji, "TCON") == 0){TCON();}
ryousato 2:5e6613f149d4 1083 else if(strcmp(moji, "TCONread") == 0){TCONread();}
ryousato 2:5e6613f149d4 1084 else if(strcmp(moji, "read") == 0){read();}
ryousato 3:d55ebd20d750 1085 else if(strcmp(moji, "write00") == 0){write00();}
ryousato 3:d55ebd20d750 1086 else if(strcmp(moji, "write7F") == 0){write7F();}
ryousato 3:d55ebd20d750 1087 else if(strcmp(moji, "writeFF") == 0){writeFF();}
ryousato 2:5e6613f149d4 1088 else if(strcmp(moji, "WLAT") == 0){WLAT();}
ryousato 3:d55ebd20d750 1089 else if(strcmp(moji, "CS0") == 0){CS(0);}
ryousato 3:d55ebd20d750 1090 else if(strcmp(moji, "CS1") == 0){CS(1);}
ryousato 3:d55ebd20d750 1091 else if(strcmp(moji, "AD1") == 0){AD(1);}
ryousato 3:d55ebd20d750 1092 else if(strcmp(moji, "AD2") == 0){AD(2);}
ryousato 3:d55ebd20d750 1093 else if(strcmp(moji, "TENinc") == 0){TENinc();}
ryousato 3:d55ebd20d750 1094 else if(strcmp(moji, "att1") == 0){att(1);}
ryousato 3:d55ebd20d750 1095 else if(strcmp(moji, "att2") == 0){att(2);}
ryousato 3:d55ebd20d750 1096 else if(strcmp(moji, "att3") == 0){att(3);}
ryousato 3:d55ebd20d750 1097 else if(strcmp(moji, "det") == 0){det();}
ryousato 3:d55ebd20d750 1098 else if(strcmp(moji, "AD1_Vrms") == 0){ADVrms(1);}
ryousato 3:d55ebd20d750 1099 else if(strcmp(moji, "AD2_Vrms") == 0){ADVrms(2);}
ryousato 3:d55ebd20d750 1100 else if(strcmp(moji, "AD3_Vrms") == 0){ADVrms(3);}
ryousato 4:e69f73c66598 1101
ryousato 3:d55ebd20d750 1102 else serial.printf("\r\n\r\n NG!\r\n");
ryousato 0:df1e1f84ded8 1103 }
ryousato 3:d55ebd20d750 1104 else count++; // 文字カウンタに1加算
ryousato 0:df1e1f84ded8 1105 }
ryousato 0:df1e1f84ded8 1106 }
ryousato 0:df1e1f84ded8 1107
ryousato 3:d55ebd20d750 1108 /******************************************************************************/
ryousato 3:d55ebd20d750 1109 //メインプログラム
ryousato 3:d55ebd20d750 1110 /******************************************************************************/
ryousato 0:df1e1f84ded8 1111 int main() {
ryousato 3:d55ebd20d750 1112 pAVrefcal = &ActualVref[0];
ryousato 3:d55ebd20d750 1113 pmode = &mode_p;
ryousato 3:d55ebd20d750 1114
ryousato 3:d55ebd20d750 1115 led1 = 1;
ryousato 3:d55ebd20d750 1116 wait(0.2);
ryousato 0:df1e1f84ded8 1117 setup();
ryousato 3:d55ebd20d750 1118 initial();
ryousato 4:e69f73c66598 1119 offsetcal(1);
ryousato 4:e69f73c66598 1120 offsetcal(2);
ryousato 4:e69f73c66598 1121 offsetcal(3);
ryousato 4:e69f73c66598 1122 led1 = 1;
ryousato 4:e69f73c66598 1123 coilEN2 = 1; //TRANS_OUT出力
ryousato 4:e69f73c66598 1124 coilEN3 = 1; //CT1,2_OUT出力
ryousato 4:e69f73c66598 1125 coilEN4 = 0;
ryousato 4:e69f73c66598 1126 led1 = 0;
ryousato 2:5e6613f149d4 1127 serialstart();
ryousato 2:5e6613f149d4 1128
ryousato 3:d55ebd20d750 1129 //*(volatile int *)0x4004402C = 0x2; // (レジスタ値を直接入力) アドレス0x4004402Cに値を代入
ryousato 3:d55ebd20d750 1130 //*(volatile int *)0x4004402C;
ryousato 3:d55ebd20d750 1131 //serial.printf( "data in 0x4004402C is 0x%08X\n", *(volatile int *)0x4004402C ); // アドレス0x4004402Cの値を表示
ryousato 3:d55ebd20d750 1132
ryousato 0:df1e1f84ded8 1133 while(1){
ryousato 0:df1e1f84ded8 1134 serial_inout();
ryousato 0:df1e1f84ded8 1135 }
ryousato 3:d55ebd20d750 1136
ryousato 0:df1e1f84ded8 1137
ryousato 3:d55ebd20d750 1138 }