ryou sato
/
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
Revision 9:0b3a7a9eed3e, committed 2021-03-09
- Comitter:
- ryousato
- Date:
- Tue Mar 09 05:40:47 2021 +0000
- Parent:
- 8:aea096edd536
- Commit message:
- 20210309
Changed in this revision
| LPC11U35_MCP41HV51-503EST.lib | Show annotated file Show diff for this revision Revisions of this file |
| main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/LPC11U35_MCP41HV51-503EST.lib Tue Mar 09 05:40:47 2021 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/ryousato/code/LPC11U35_MCP41HV51-503EST/#aea096edd536
--- a/main.cpp Wed Sep 09 02:05:40 2020 +0000
+++ b/main.cpp Tue Mar 09 05:40:47 2021 +0000
@@ -1,4 +1,4 @@
-//////////////////////////////////////////////////
+//////////////////////////////////////////////////
// Include Files
#include "mbed.h"
#include "LPC11Uxx.h"
@@ -8,1420 +8,236 @@
//Configure the PC Serial Port for CDC USB
USBSerial serial;
Serial device(P0_19,P0_18);
-Ticker OffsetCal;
-Ticker timerint;
-Timer timecount;
-
-//Pin Defines
-DigitalOut led1(LED1);
char moji[32]; //入力文字列
-int suuji[6];
int count = 0; //文字数カウンタ
-int CorF;
-int adjmode;
-int val; //POTのワイパー移動数
-int incr;
-int wa;
- int mode_p = 0;
- int *pmode;
- int CTrange; //[60A:120A] [0:1]
- int *pCTrange;
-float Vcc = 3.292; //実測値を入力すること
-float Vref;
- float ActualVref[4] = {1.65, 1.65, 1.65, 1.65};
- float *pAVrefcal;
-int AD_flag;
-float AD_val = 0;
-float AD_val_sum = 0;
-float Vrms = 0;
-float set_val = 0;
-float diff = 0;
-//float zero_cal[2];
-int AD_count = 0;
-float setval = 0;
-
-
-DigitalOut coilEN1(P0_1);
-DigitalOut coilEN2(P0_2);
-DigitalOut coilEN3(P0_3);
-DigitalOut coilEN4(P0_4);
-DigitalOut coilEN5(P0_5);
-DigitalOut coilEN6(P0_20);
-DigitalOut coilEN7(P1_19);
-
-DigitalOut ENn(P0_16);
-DigitalOut addr0(P0_17);
-DigitalOut addr1(P0_18);
-DigitalOut addr2(P0_19);
-
-DigitalOut SCT_AMP(P0_10);
-DigitalOut WLATn(P0_23);
-DigitalOut SHDNn(P1_15);
-
-AnalogIn AD_TRANS_IN(P0_11); //AD_TRANS_IN
-AnalogIn AD_CT_IN(P0_12); //AD_CT_IN
-
-
-SPI spi(P0_9, P0_8, P0_6);
-
-void setup() {
- spi.format(16,0);
- wait(0.02);
- spi.frequency(1000000);
- device.baud(115200);
- coilEN1 = 0; //50Hz
- coilEN2 = 0; //TRANS_OUT調整
- coilEN3 = 0; //CT1,2_OUT調整
- coilEN4 = 0; //CT1,2_OUT選択
- coilEN5 = 0; //±5V,±15 OFF
- coilEN6 = 0; //未使用
- coilEN7 = 0; //未使用
-
- ENn = 1; //CD74HC4051E CSをディセーブル
- addr0 = 0;
- addr1 = 0;
- addr2 = 0;
+//DigitalOut led(LED1);
+//DigitalInOut GPIOX(P0_0, PIN_OUTPUT, PullDown, 0);
+DigitalOut GPIO[] = {
+ DigitalOut (P0_22, 0),
+ DigitalOut (P0_11, 0),
+ DigitalOut (P0_12, 0),
+ DigitalOut (P0_13, 0),
+ DigitalOut (P0_14, 0),
+ DigitalOut (P0_15, 0),
+ DigitalOut (P0_16, 0),
+ DigitalOut (P0_23, 0),
+ DigitalOut (P1_15, 0),
+ DigitalOut (P0_21, 0),
+ DigitalOut (P0_5, 0),
+ DigitalOut (P0_4, 0),
+ DigitalOut (P0_3, 0),
+ DigitalOut (P0_2, 0),
+ DigitalOut (P0_20, 0),
+ DigitalOut (P1_19, 0),
+ DigitalOut (P0_1),
+ DigitalOut (P0_19, 0),
+ DigitalOut (P0_18, 0),
+ DigitalOut (P0_17, 0),
+};
+BusOut muxaddr(P0_7,P0_8,P0_9,P0_10); //マルチプレクサADDRバス
- WLATn = 1; //MCP41HV51-503EST ワイパーラッチ
- SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
- CTrange = 0;
- SHDNn = 1; //電流帰還アンプ シャットダウンしない
-}
-
-void serialstart(){
- wait(0.02);
- serial.printf("\r\nReady!\r\n");
- wait(0.02);
-}
-
-void helpwrite(){
+void helpwrite()
+{
serial.printf("\r\n------------------");
- //serial.printf("\r\ncmd");
- serial.printf("\r\nhelp");
- //serial.printf("\r\n?");
- serial.printf("\r\ninitial");
- serial.printf("\r\nV_OFF");
- serial.printf("\r\nV_ON");
- serial.printf("\r\n50Hz");
- serial.printf("\r\n60Hz");
- serial.printf("\r\nTRANS_OUT_ADINT");
- serial.printf("\r\nCT1_OUT_ADINT");
- serial.printf("\r\nCT2_OUT_ADINT");
- serial.printf("\r\nTRANS_OUT_EXT");
- serial.printf("\r\nCT_OUT_EXT");
- serial.printf("\r\nCTrange_60A");
- serial.printf("\r\nCTrange_120A");
- serial.printf("\r\nTRANS_offset");
- serial.printf("\r\nCT_offset");
-// serial.printf("\r\nCT2_offset");
- serial.printf("\r\ndispVref");
- serial.printf("\r\nTRANS_ADJ_100V");
- serial.printf("\r\nCT1_ADJ_60A");
- serial.printf("\r\nCT2_ADJ_60A");
- serial.printf("\r\nTRANS_ADJ_MODE");
- serial.printf("\r\nCT1_ADJ_MODE");
- serial.printf("\r\nCT2_ADJ_MODE");
- serial.printf("\r\nMANUAL_TRANS_ADJ");
- serial.printf("\r\nMANUAL_CT1_ADJ");
- serial.printf("\r\nMANUAL_CT2_ADJ");
+ serial.printf("\r\nrelayALLoff");
+ serial.printf("\r\nrelay{1|...|8}");
+ serial.printf("\r\nGPIOALL{L|H}");
+ serial.printf("\r\nGPIO{1|...|20}{L|H}");
serial.printf("\r\n------------------");
}
-//MCP41HV51コマンド
-//デバッグ用
-void TCON(){ //端子スイッチ接続
- int whoami = spi.write(0x40FF);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-//デバッグ用
-void TCONread(){
- int whoami = spi.write(0x4C00);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-//デバッグ用
-void read(){
- int read_val = spi.write(0x0C00);
- serial.printf("\r\nread_val = 0x%X", read_val);
-}
-
-//デバッグ用
-void write00(){
- int whoami = spi.write(0x0000);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-//デバッグ用
-void write7F(){
- int whoami = spi.write(0x007F);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-//デバッグ用
-void writeFF(){
- int whoami = spi.write(0x00FF);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-//デバッグ用
-void TENinc(){
- int readval = spi.write(0x0C00);
- int incval = readval & 0xFF;
- incval = incval + 10;
- int whoami = spi.write(incval);
- serial.printf("\r\nWHOAMI register = 0x%X", whoami);
-}
-
-void WLAT(){
- WLATn = 0;
- wait(0.02);
- WLATn = 1;
- //serial.printf("\r\n OK(WLAT)");
-}
-
-//CD74HC4051Eのイネーブル
-void CS(int cs){
- ENn = cs;
- serial.printf("\r\n OK(CS)");
-}
-
-/******************************************************************************/
-//CD74HC4051Eのアドレスセレクト
-/******************************************************************************/
-void ADDR(int addr){
- ENn = 1; //CSをディセーブルにしておく
- wait(0.02);
- if(addr == 0){
- addr0 = 0;
- addr1 = 0;
- addr2 = 0;
- }
- else if(addr == 1){
- addr0 = 0;
- addr1 = 1;
- addr2 = 0;
- }
- else if(addr == 2){
- addr0 = 1;
- addr1 = 0;
- addr2 = 0;
- }
- else if(addr == 3){
- addr0 = 1;
- addr1 = 1;
- addr2 = 0;
- }
- else if(addr == 4){
- addr0 = 0;
- addr1 = 0;
- addr2 = 1;
- }
- else if(addr == 5){
- addr0 = 1;
- addr1 = 0;
- addr2 = 1;
- }
- else if(addr == 6){
- addr0 = 0;
- addr1 = 1;
- addr2 = 1;
- }
- else if(addr == 7){
- addr0 = 1;
- addr1 = 1;
- addr2 = 1;
- }
- wait(0.02);
- ENn = 0; //イネーブル
- wait(0.02);
- //serial.printf("\r\n OK(ADDR%d)", addr);
-}
-
-/******************************************************************************/
-//POT制御
-//指定したPOTの現在値から、指定した量を増減する
-/******************************************************************************/
-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]
- //現在の設定値読み取り
- ADDR(mode * 2 + CorF -2);
- int read_val = spi.write(0x0C00);
- read_val &= 0x00FF;
-
- //現在の設定値から増減値書き込み
- int write_val;
- if(incr == 1){write_val = read_val + val;}
- else if(incr == 0){write_val = read_val - val;}
- spi.write(write_val);
-
- wait(0.001);
-
- //粗、微 読み取り
- ADDR(mode * 2); //TRANS粗調整POT
- int read_val_Coarse = spi.write(0x0C00);
- read_val_Coarse &= 0x00FF;
-
- wait(0.001);
-
- ADDR(mode * 2 - 1); //TRANS微調整POT
- int read_val_Fine = spi.write(0x0C00);
- read_val_Fine &= 0x00FF;
-
- WLAT();
-
- wait(0.001);
-
- ENn = 1; //ディセーブル
-
- serial.printf("\r\n Status --- Coarse[%d/255], Fine[%d/255] ---", read_val_Coarse, read_val_Fine);
-}
-
-/******************************************************************************/
-//AD変換
-//デバッグ用
-/******************************************************************************/
-
-void AD(int ad){
- unsigned short AD_Val;
- float AD_Val_f;
- if(ad == 1){
- AD_Val = (AD_TRANS_IN.read_u16() >> 6); //右シフト「>> 6」で10bit分解能に合わせる
- AD_Val_f = AD_TRANS_IN.read();
- }
- else if(ad == 2){
- AD_Val = (AD_CT_IN.read_u16() >> 6); //右シフト「>> 6」で10bit分解能に合わせる
- AD_Val_f = AD_CT_IN.read();
- }
- wait(0.02);
- serial.printf("\r\nAD_Val : %1f [V] / (%d)d / (%x)h",(AD_Val*Vcc/1023),AD_Val,AD_Val);
- serial.printf("\r\nAD_Val_f : %1f [V] / (%f)d",(AD_Val_f*Vcc),AD_Val_f);
-}
-
-
-
-void AD_CT(){
- float AD_Val;
- AD_Val = AD_TRANS_IN.read();
- wait(0.02);
- serial.printf("\r\n%1.3f",AD_Val);
+void Vswitch(int tmpInt)
+{
+ //ADDRバス切替
+ if (tmpInt<7) {
+ muxaddr.write(tmpInt);
+ } else if (tmpInt>=7) {
+ tmpInt = tmpInt + 1;
+ muxaddr.write(tmpInt);
}
-
-/******************************************************************************/
-//各POT初期設定
-//mode 1:TRANS 2:CT1 3:CT2
-/******************************************************************************/
-void POTini(int mode){
- ADDR(mode * 2); //TRANS粗調整POT
- if(mode==1){spi.write(0x0076);}
- else if(mode==2 || mode==3){spi.write(0x006B);}
-
- wait(0.001);
-
- ADDR(mode * 2 - 1); //TRANS微調整POT
- spi.write(0x007F);
-
- WLAT();
-
- wait(0.001);
-
- ENn = 1; //ディセーブル
-}
-
-/******************************************************************************/
-//初期設定
-//TRANS_OUT,CT1,2_OUTを初期値(50Hz,AC100V,60A相当)に調整
-/******************************************************************************/
-void initial(){
- //全てのPOTの端子スイッチをONにする(TCON)
- ADDR(1); //TRANS微調整POT
- spi.write(0x40FF);
- ADDR(2); //TRANS粗調整POT
- spi.write(0x40FF);
- ADDR(3); //CT1微調整POT
- spi.write(0x40FF);
- ADDR(4); //CT1粗調整POT
- spi.write(0x40FF);
- ADDR(5); //CT2微調整POT
- spi.write(0x40FF);
- ADDR(6); //CT2粗調整POT
- spi.write(0x40FF);
- wait(0.02);
- ENn = 1; //CSをディセーブル
-
- coilEN5 = 1; //±5V,±15VをON
-
- coilEN1 = 0; //50Hz切替え
-
- SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
- CTrange = 0;
- SHDNn = 1; //電流帰還アンプ シャットダウンしない
-
- //TRANS_OUT初期設定
- coilEN2 = 0; //TRANS_OUTをAD入力方向へ切替え
-
- ADDR(2); //TRANS粗調整POT
- spi.write(0x0076);
- //read();
- ADDR(1); //TRANS微調整POT
- spi.write(0x007F);
- //read();
- WLAT(); //設定したワイパーをラッチ
- wait(0.02);
- ENn = 1; //CSをディセーブル
-
- //CT1_OUT初期設定
- coilEN3 = 0; //CT1_OUT1と2をAD入力方向へ切替え
- coilEN4 = 0; //CT1を選択
-
- ADDR(4); //CT1粗調整POT
- spi.write(0x006B);
- //read();
- ADDR(3); //CT1微調整POT
- spi.write(0x007F);
- //read();
- WLAT(); //設定したワイパーをラッチ
- wait(0.02);
- ENn = 1; //CSをディセーブル
-
- //CT2_OUT初期設定
- coilEN3 = 0; //CT1_OUT1と2をAD入力方向へ切替え
- coilEN4 = 1; //CT2を選択
-
- POTini(3);
- ADDR(6); //CT2粗調整POT
- spi.write(0x006B);
- //read();
- ADDR(5); //CT2微調整POT
- spi.write(0x007F);
- //read();
- WLAT(); //設定したワイパーをラッチ
- wait(0.02);
- ENn = 1; //CSをディセーブル
-
- coilEN2 = 1; //TRANS_OUT出力
- coilEN3 = 1; //CT1,2_OUT出力
- coilEN4 = 0;
-
-/*
- for(int i=0; i<10*2; i++){
- led1 = !led1;
- wait(0.1);
- }
- led1 = 0;
-*/
- serial.printf("\r\n OK(initial)");
-}
-
-/******************************************************************************/
-//手動調整
-/******************************************************************************/
-void manual_adj(int mode){
- if(mode == 2 || mode == 3){
- serial.printf("\r\n Select range mode. Type '60A' or '120A'.");
- while(1){
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 5 ){ // ①文字数が既定の個数になった場合
- moji[5] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
-
- else if(moji[0] == '\n'){count = 0;}
-
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if (strcmp(moji, "60A") == 0){
- SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
- CTrange = 0;
- break;}
- else if(strcmp(moji, "120A") == 0){
- SCT_AMP = 1; //CT入力アンプ 120Aレベル切替え
- CTrange = 1;
- break;}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
- }
- }
- serial.printf("\r\n OK");
- }
-
-/*
- if(mode == 1){coilEN2 = 0;} //TRANS_OUTをAD入力方向へ切替え
- else if(mode == 2){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1と2をAD入力方向へ切替え
- else if(mode == 3){coilEN3 = 0; coilEN4 = 1;} //CT1_OUT1と2をAD入力方向へ切替え
-*/
-
- //POTの状態を確認し、ステータス情報に表示する
- ADDR(mode * 2); //TRANS粗調整POT
- wait(0.2);
- int read_val_Coarse = spi.write(0x0C00);
- read_val_Coarse &= 0x00FF;
-
- ADDR(mode * 2 - 1); //TRANS微調整POT
- wait(0.2);
- int read_val_Fine = spi.write(0x0C00);
- read_val_Fine &= 0x00FF;
- ENn = 1; //CSをディセーブル
- serial.printf("\r\n\r\n Status --- Coarse[%d/255], Fine[%d/255] ---\r\n", read_val_Coarse, read_val_Fine);
-
-
- //ループスタート
- while(1){ //ループ1
- serial.printf("\r\n Select mode '+-' or 'num'. ('q' quit)\r\n");
- while(1){ //adjmode
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 4 ){ // ①文字数が既定の個数になった場合
- moji[4] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
-
- else if(moji[0] == '\n'){count = 0;}
-
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if (strcmp(moji,"+-") == 0){
- adjmode = 1;
- break;}
- else if(strcmp(moji,"num") == 0){
- adjmode = 2;
- break;}
- else if(strcmp(moji,"q") == 0){break;}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
- }
- } //adjmode
-
- if(strcmp(moji,"q")==0){serial.printf("\r\n quit\r\n"); break;} //ループ1ブレイク
-
- while(1){ //ループ2
- serial.printf("\r\n Type 'C' for Coarse or 'F' for Fine. ('q' quit, 'b' back)\r\n");
- while(1){ //CorF setting
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 2 ){ // ①文字数が既定の個数になった場合
- moji[2] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
-
- else if(moji[0] == '\n'){count = 0;}
-
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if (strcmp(moji, "C") == 0){
- CorF = 2; //粗調整
- serial.printf("\r\n---Coarse Setting---");
- break;}
- else if(strcmp(moji, "F") == 0){
- CorF = 1; //微調整
- serial.printf("\r\n---Fine Setting---");
- break;}
- else if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
- }
- }//CorF setting
-
- if(strcmp(moji,"b")==0){
- serial.printf("\r\n return\r\n");
- break; //ループ2ブレイク
- }
- else if(strcmp(moji,"q")==0){break;} //ループ2ブレイク
-
- while(1){ //ループ3
- if(adjmode == 1){
- serial.printf("\r\n Type '+' for increment, '-' for decrement. ('q' quit, 'b' back)");
- while(1){ //+-モード
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("\r\n%c", moji[count]); //シリアル出力表示
- moji[1] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
-
- if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
- else if(strcmp(moji,"\n") == 0){}
- else if(strcmp(moji,"+") == 0){incdec(1,1,CorF,mode);}
- else if(strcmp(moji,"-") == 0){incdec(0,1,CorF,mode);}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- } //+-モード
- if(strcmp(moji,"b")==0){
- serial.printf("\r\n return\r\n");
- break; //ループ3ブレイク
- }
- else if(strcmp(moji,"q")==0){break;} //ループ3ブレイク
- }
- else if(adjmode == 2){
- while(1){ //ループ4
- serial.printf("\r\n Type '+' for increase, '-' for decrease. ('q' quit, 'b' back)");
- while(1){ //numモード
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 2 ){ // ①文字数が既定の個数になった場合
- moji[2] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
-
- else if(moji[0] == '\n'){count = 0;}
-
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if (strcmp(moji, "+") == 0){
- incr = 1; //増加
- serial.printf("\r\n---increase---");
- break;}
- else if(strcmp(moji, "-") == 0){
- incr = 0; //減少
- serial.printf("\r\n---decrease---");
- break;}
- else if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
- }
- } //numモード
- if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;} //ループ4ブレイク
- while(1){ //ループ5
- serial.printf("\r\n Type number [0-255]. ('q' quit, 'b' back)");
- for(int i=0; i<3; i++){moji[i] = '0';}
-
- while(1){ //numモード2
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 4 ){ // ①文字数が既定の個数になった場合
- moji[4] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
- else if(moji[0] == '\n'){count = 0;}
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if(strcmp(moji,"b")==0 || strcmp(moji,"q")==0){break;}
- for(int i=0; i<3; i++){suuji[i] = 0;}
- for(int i=0; i<3; i++){
- suuji[i] = moji[i];
- suuji[i] -= 48;
- }
- for(int i=0; i<3; i++){moji[i] = '0';}
- if(suuji[0]>=0&&suuji[0]<=9){
- if(suuji[1]>=0&&suuji[1]<=9){
- if(suuji[2]>=0&&suuji[2]<=9){
- suuji[0] *= 100;
- suuji[1] *= 10;
- }
- else{
- suuji[0] *= 10;
- suuji[2] = 0;
- }
- }
- else{
- suuji[1] = 0;
- suuji[2] = 0;
- }
- }
- else{serial.printf("\r\n\r\n NG!\r\n"); break;}
-
- wa = suuji[0]+suuji[1]+suuji[2];
-
- incdec(incr,wa,CorF,mode);
-
- }
- else count++; // 文字カウンタに1加算
- }
- } //numモード2
- if(strcmp(moji,"b")==0){
- serial.printf("\r\n return\r\n");
- break; //ループ5ブレイク
- }
- else if(strcmp(moji,"q")==0){break;}
- } //ループ5
- if(strcmp(moji,"q")==0){break;} //ループ5→4ブレイク
- } //ループ4
- if(strcmp(moji,"b")==0){
- serial.printf("\r\n return\r\n");
- break; //ループ4→3ブレイク
- }
- else if(strcmp(moji,"q")==0){break;} //ループ4→3ブレイク
- } //if文
- } //ループ3
- if(strcmp(moji,"q")==0){break;} //ループ3→2ブレイク
- } //ループ2
- if(strcmp(moji,"q")==0){
- serial.printf("\r\n quit\r\n");
- break; //ループ2→1ブレイク
- }
- } //ループ１
-
- serial.printf("\r\n MANUAL_ADJ END");
-}
-
-/******************************************************************************/
-//タイマー割込み https://monoist.atmarkit.co.jp/mn/articles/1506/19/news001_2.html
-/******************************************************************************/
-/*
-void attime(){
- led1 = !led1;
-}
-*/
-/******************************************************************************/
-//タイマー割込み
-//オフセット補正したActualVrefを求める (平均値を出しているだけ)
-/******************************************************************************/
-void AVrefcal(){
- led1 = !led1;
-
- if(mode_p == 1){AD_val = AD_TRANS_IN.read();}
- else if(mode_p==2 || mode_p==3){AD_val = AD_CT_IN.read();}
-
- AD_val = AD_val * Vcc; //(val)
- AD_flag = 1;
-
- //serial.printf("\r\n AD_val = %f",AD_val);
+ wait(0.01);
+ serial.printf("\r\n OK");
}
-////////////////////////////
-//サンプリング ActualVref
-//mode 1:TRANS 2:CT1 3:CT2
-////////////////////////////
-void offsetcal(int mode){
- AD_count = 0;
- AD_flag = 0;
- AD_val = 0;
- AD_val_sum = 0;
-
- mode_p = mode;
- if(mode == 1){coilEN2 = 1;} //TRANS_OUTを出力方向へ切替え
- else if(mode == 2){coilEN3 = 1;} //CT1_OUT1と2を出力方向へ切替え
- else if(mode == 3){coilEN3 = 1;} //CT1_OUT1と2を出力方向へ切替え
-
- wait(0.05);
-
-
- //timerint.attach(&AVrefcal,0.020408); //49Hz
- timerint.attach(&AVrefcal,0.008); //125Hz
-
- timecount.start();
-
- while(1){
- if(AD_count < 250 && AD_flag == 1){ //サンプリング数0~Nで、サンプル取得されたとき
- AD_count ++;
- AD_val_sum += AD_val;
- AD_flag = 0;
- if(AD_count == 0){timecount.start();} //0~Nのサンプリング時間計測用スタート時
- else if(AD_count == 250){ //0~Nのサンプリング時間計測用ストップ時
- timecount.stop();
- //serial.printf("\r\n t = %f",timecount.read()); //計測時間表示
- timecount.reset();
- }
- }
- else if(AD_count < 250 && AD_flag == 0){} //サンプリング数0~Nで、サンプル取得されてないとき
- else{ //サンプリング完了時
- Vref = AD_val_sum / AD_count;
- ActualVref[mode_p] = Vref; //格納
- if(mode_p == 2){ActualVref[3] = Vref;}
- serial.printf("\r\n Vref%d = %f",mode_p,ActualVref[mode_p]);
- break;
- }
- }
- timerint.detach();
- led1 = 0;
-}
-
-void dispVref(){
- serial.printf("\r\n TRANS_Vref = %f",ActualVref[1]);
- serial.printf("\r\n CT_Vref = %f",ActualVref[2]);
-// serial.printf("\r\n CT2___Vref = %f",ActualVref[3]);
-}
-/******************************************************************************/
-//タイマー割込み
-//AD変換によりVrmsを求める
-/******************************************************************************/
-//タイマー割込み実行関数
-void timerAD(){
- led1 = !led1;
- //serial.printf("\r\n mode_p = %d",mode_p);
- //serial.printf("\r\n ActualVref = %f",ActualVref[mode_p]);
-
- if(mode_p == 1){AD_val = AD_TRANS_IN.read();}
- else if(mode_p==2 || mode_p==3){AD_val = AD_CT_IN.read();}
-
- //serial.printf("\r\n AD_val = %f",AD_val);
-
- AD_val *= Vcc;
- AD_val -= ActualVref[mode_p];
- //serial.printf("\r\n AD_val*Vcc-Vref = %f",AD_val);
- AD_val *= AD_val;
- AD_flag = 1;
-
- //serial.printf("\r\n AD_val = %f",AD_val);
-}
-////////////////////////////
-//サンプリング Vrms
-//mode 1:TRANS 2:CT1 3:CT2
-////////////////////////////
-void ADVrms(int mode){
- AD_count = 0;
- AD_flag = 0;
- AD_val = 0;
- AD_val_sum = 0;
-
- mode_p = mode;
- if(mode == 1){coilEN2 = 0;} //TRANS_OUTをAD入力方向へ切替え
- else if(mode == 2){coilEN3 = 0; coilEN4 = 0;} //CT1_OUT1をAD入力方向へ切替え
- else if(mode == 3){coilEN3 = 0; coilEN4 = 1;} //CT1_OUT2をAD入力方向へ切替え
-
- wait(0.05);
-
-// timerint.attach(&timerAD,0.020408);
- timerint.attach(&timerAD,0.008); //125Hz
-
- timecount.start();
-
- while(1){
- if(AD_count < 250 && AD_flag == 1){ //サンプリング数0~Nで、サンプル取得されたとき
- AD_count ++;
- AD_val_sum += AD_val;
- AD_flag = 0;
- if(AD_count == 0){timecount.start();} //0~Nのサンプリング時間計測用スタート時
- else if(AD_count == 250){ //0~Nのサンプリング時間計測用ストップ時
- timecount.stop();
- //serial.printf("\r\n t = %f",timecount.read());
- timecount.reset();
- }
- }
- else if(AD_count < 250 && AD_flag == 0){}//サンプリング数0~Nで、サンプル取得されてないとき
- else{ //サンプリング完了時
- AD_val_sum /= AD_count;
- Vrms = sqrtf(AD_val_sum);
- //serial.printf("\r\n AD_val_sum = %f",AD_val_sum);
- serial.printf("\r\n Vrms = %f",Vrms);
- break;
- }
- }
- timerint.detach();
- led1 = 0;
-}
-
-//デバッグ用
-void att(int mode){
- mode_p = mode;
- //timerint.attach(&timerAD,0.020408); //サンプリング数=49 20.4ms周期
- timerint.attach(&timerAD,0.008);
- }
-void det(){timerint.detach();}
-
-/******************************************************************************/
-//自動調整(コマンド)
-//TRANS_OUT設定範囲 : AC 50~138V
-//CT1,2_OUT設定範囲 : AC 10~120A
-/******************************************************************************/
-void auto_adj(int mode, float setval){
-
- int adjnum = 0; //コマンド判定フラグ
-
- //設定範囲判定 と Vrms換算
- if(mode == 1) {
- if(setval >= 50 && setval <= 138) {
- setval = setval * 0.12 * 0.196078; //0.12:トランス比 0.196078:分圧抵抗比
- //serial.printf("\r\n %f",setval);
- setval /= 2;
- setval /= sqrtf(2);
- serial.printf("\r\n setval = %f",setval);
- } else {
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
- }
- } else if(mode==2 || mode==3) {
- if(setval >= 10 && setval <= 120) {
- if(setval >= 61 && setval <= 120) {
- SCT_AMP = 1;
- CTrange = 1;
- }
- if(CTrange == 0) {
- setval = setval / 3000 * 10 * 5.666667; //3000:CT比 10:終端抵抗 5.666667:分圧抵抗比
- } else if(CTrange == 1) {
- setval = setval / 3000 * 10 * 2.833333; //3000:CT比 10:終端抵抗 2.833333:分圧抵抗比
- }
- serial.printf("\r\n setval = %f",setval);
- } else {
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
+void GPIOswitch(int tmpIO, int tmpInt)
+{
+ if (tmpIO==0) {
+ for(int i=0; i<=19; i++) {
+ GPIO[i] = tmpInt;
}
} else {
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
+ tmpIO = tmpIO - 1;
+ GPIO[tmpIO] = tmpInt;
}
- int adjcount = 0; //ループ2上限変数
-
- while(1) { //ループ2
- if(adjnum == 1) {
- serial.printf("\r\n\r\n COMMAND ERROR!");
- break; //ループ2ブレイク
- } else if(adjcount >= 15) { //ループ2上限値
- serial.printf("\r\n\r\n ERROR!\r\n");
- break; //ループ2ブレイク
- }
-
- ADVrms(mode); //現在のVrms値
-
- diff = setval - Vrms; //差分
- //serial.printf("\r\n diff = %f",diff);
-
- //増減方向判定
- if(diff > 0) {
- incr = 1; //増
- } else if(diff < 0) {
- incr = 0; //減
- diff *= -1; //絶対値
- } else if(diff == 0) {
- break; //差分無し ループ2ブレイク
- }
- serial.printf("\r\n diff = %f",diff);
- serial.printf("\r\n incr = %d",incr);
-
-
- //粗、微 読み取り
- ADDR(mode * 2); //TRANS粗調整POT
- int read_val_Coarse = spi.write(0x0C00);
- read_val_Coarse &= 0x00FF;
-
- wait(0.001);
-
- ADDR(mode * 2 - 1); //TRANS微調整POT
- int read_val_Fine = spi.write(0x0C00);
- read_val_Fine &= 0x00FF;
-
- //serial.printf("\r\n read_val_Coarse = %d",read_val_Coarse);
- //serial.printf("\r\n read_val_Fine = %d",read_val_Fine);
-
-
- if(mode == 1) {
- //粗・微 調整判定
- float diffref_C = 0.000412 / 255 * read_val_Fine + 0.0032;
- float diffref_F = 0.000412 / 255 * read_val_Coarse + 0.000165;
- float diffcom = diffref_C * 1.5;
- //serial.printf("\r\n diffref_C = %f",diffref_C);
- //serial.printf("\r\n diffref_F = %f",diffref_F);
- //serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom) {
- CorF = 2; //粗
- } else if(diff < diffcom) {
- CorF = 1; //微
- if(diff < 0.001) {
- break; //差分微小 ループ2ブレイク(通常最終ゴール)
- }
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2) {
- val = diff / diffref_C;
- } else if(CorF == 1) {
- val = diff / diffref_F;
- }
- serial.printf("\r\n tap(val) = %d",val);
- } else if(mode==2 || mode==3) {
- if(CTrange == 0) { //60Aのとき
- //粗・微 調整判定
- float diffref_C = 0.001966 / 255 * read_val_Fine + 0.00885;
- float diffref_F = 0.001966 / 255 * read_val_Coarse + 0.0001;
- float diffcom = diffref_C * 1.5;
- //serial.printf("\r\n diffref_C = %f",diffref_C);
- //serial.printf("\r\n diffref_F = %f",diffref_F);
- //serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom) {
- CorF = 2; //粗
- } else if(diff < diffcom) {
- CorF = 1; //微
- if(diff < 0.002) {
- break; //差分微小 ループ2ブレイク(通常最終ゴール)
- }
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2) {
- val = diff / diffref_C;
- } else if(CorF == 1) {
- val = diff / diffref_F;
- }
- serial.printf("\r\n tap(val) = %d",val);
- } else if(CTrange == 1) { //120Aのとき
- //粗・微 調整判定
- float diffref_C = 0.000983 / 255 * read_val_Fine + 0.0044;
- float diffref_F = 0.000983 / 255 * read_val_Coarse + 0.000049;
- float diffcom = diffref_C * 1.5;
- //serial.printf("\r\n diffref_C = %f",diffref_C);
- //serial.printf("\r\n diffref_F = %f",diffref_F);
- //serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom) {
- CorF = 2; //粗
- } else if(diff < diffcom) {
- CorF = 1; //微
- if(diff < 0.002) {
- break; //差分微小 ループ2ブレイク(通常最終ゴール)
- }
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2) {
- val = diff / diffref_C;
- } else if(CorF == 1) {
- val = diff / diffref_F;
- }
- serial.printf("\r\n tap(val) = %d",val);
- }
- }
- //ワイパー位置移動
- incdec(incr, val, CorF, mode);
-
- adjcount ++;
-
- } //ループ2
-
- if(mode==1) {
- coilEN2 = 1; //TRANS_OUTを外部出力へ切替え
- } else if(mode==2 || mode==3) {
- coilEN3 = 1; //CT1_OUT1と2を外部出力へ切替え
- coilEN4 = 0;
- }
-
- serial.printf("\r\n ADJ END");
-}
-
-/******************************************************************************/
-//自動調整(モード)
-//TRANS_OUT設定範囲 : AC 50~138V
-//CT1,2_OUT設定範囲 : AC 10~120A
-/******************************************************************************/
-void auto_adj_mode(int mode){
-
-///////////////////////////////////////////////////////////////////////////////
- POTini(mode); //POTを初期値に設定
-///////////////////////////////////////////////////////////////////////////////
-
- //'60A' or '120A'
- if(mode == 2 || mode == 3){
- serial.printf("\r\n Select range mode. Type '60A' or '120A'.");
- while(1){
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 5 ){ // ①文字数が既定の個数になった場合
- moji[5] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- }
-
- else if(moji[0] == '\n'){count = 0;}
-
- else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if (strcmp(moji, "60A") == 0){
- SCT_AMP = 0; //CT入力アンプ 60Aレベル切替え
- CTrange = 0;
- break;}
- else if(strcmp(moji, "120A") == 0){
- SCT_AMP = 1; //CT入力アンプ 120Aレベル切替え
- CTrange = 1;
- break;}
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
- }
- }
- serial.printf("\r\n OK");
- } //'60A' or '120A'
-
- while(1) { //ループ1
- int adjnum = 0;
-
- //シリアル表示
- if(mode == 1) {
- serial.printf("\r\n Type number AC [50-138] V. ('q' quit)");
- } else if(mode==2 || mode==3) {
- serial.printf("\r\n Type number AC [10-120] A. ('q' quit)\r\n (If 61~120A, range mode change 120A automatically.)");
- }
-
- for(int i=0; i<3; i++) {
- moji[i] = '0'; //mojiを初期化
- }
-
- while(1) { //adjnumループ
- if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
-
- if(count == 4 ) { // ①文字数が既定の個数になった場合
- moji[4] = '\0'; // 末尾に終端文字を入れる
- serial.printf("\r\n\r\n ERROR!\r\n");
- count = 0; // 文字カウンタをリセット
- } else if(moji[0] == '\n') {
- count = 0;
- } else if((moji[count] == '\r')) { // ②CRを受信した場合
- moji[count] = '\0'; //末尾に終端文字を入れる
- count = 0; //文字カウンタをリセット
- if(strcmp(moji,"q")==0) {
- break;
- }
- for(int i=0; i<3; i++) {
- suuji[i] = 0; //suujiを初期化
- }
- for(int i=0; i<3; i++) {
- suuji[i] = moji[i];
- suuji[i] -= 48; //ASCII → 10進
- }
- for(int i=0; i<3; i++) {
- moji[i] = '0'; //mojiを初期化
- }
-
- //数字であるか判定
- if(suuji[0]>=0 && suuji[0]<=9) {
- if(suuji[1]>=0&&suuji[1]<=9) {
- if(suuji[2]>=0&&suuji[2]<=9) {
- suuji[0] *= 100;
- suuji[1] *= 10;
- } else {
- suuji[0] *= 10;
- suuji[2] = 0;
- }
- } else {
- suuji[1] = 0;
- suuji[2] = 0;
- }
- } else {
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
- break; //adjnumループ ブレイク
- }
-
- setval = suuji[0]+suuji[1]+suuji[2];
-
- //設定範囲判定 と Vrms換算
- if(mode == 1){
- if(setval >= 50 && setval <= 138){
- setval = setval * 0.12 * 0.196078; //0.12:トランス比 0.196078:分圧抵抗比
- //serial.printf("\r\n %f",setval);
- setval /= 2;
- setval /= sqrtf(2);
- serial.printf("\r\n setval = %f",setval);
- break; //adjnumループ ブレイク
- }
- else{
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
- break; //adjnumループ ブレイク
- }
- }
- else if(mode==2 || mode==3){
- if(setval >= 10 && setval <= 120){
- if(setval >= 61 && setval <= 120){SCT_AMP = 1; CTrange = 1;}
- if(CTrange == 0){
- setval = setval / 3000 * 10 * 5.666667; //3000:CT比 10:終端抵抗 5.666667:分圧抵抗比
- }
- else if(CTrange == 1){
- setval = setval / 3000 * 10 * 2.833333; //3000:CT比 10:終端抵抗 2.833333:分圧抵抗比
- }
- serial.printf("\r\n setval = %f",setval);
- break; //adjnumループ ブレイク
- }
- else{
- serial.printf("\r\n\r\n NG!\r\n");
- adjnum = 1;
- break; //adjnumループ ブレイク
- }
- }
- } else count++; // 文字カウンタに1加算
- } //if
- } //adjnumループ
- if(adjnum==0 || strcmp(moji,"q")==0){break;} //ループ1ブレイク
- } //ループ1
-
- int adjcount = 0; //ループ2上限変数
-
- while(1){ //ループ2
- if(strcmp(moji,"q")==0){
- serial.printf("\r\n quit");
- break; //ループ2ブレイク
- }
- else if(adjcount >= 15){ //ループ2上限値
- serial.printf("\r\n\r\n ERROR!\r\n");
- break; //ループ2ブレイク
- }
-
- ADVrms(mode); //現在のVrms値
-
- diff = setval - Vrms; //差分
- //serial.printf("\r\n diff = %f",diff);
-
- //増減方向判定
- if(diff > 0){incr = 1;} //増
- else if(diff < 0){
- incr = 0; //減
- diff *= -1; //絶対値
- }
- else if(diff == 0){break;} //差分無し ループ2ブレイク
- serial.printf("\r\n diff = %f",diff);
- serial.printf("\r\n incr = %d",incr);
-
-
- //粗、微 読み取り
- ADDR(mode * 2); //TRANS粗調整POT
- int read_val_Coarse = spi.write(0x0C00);
- read_val_Coarse &= 0x00FF;
-
- wait(0.001);
-
- ADDR(mode * 2 - 1); //TRANS微調整POT
- int read_val_Fine = spi.write(0x0C00);
- read_val_Fine &= 0x00FF;
-
- //serial.printf("\r\n read_val_Coarse = %d",read_val_Coarse);
- //serial.printf("\r\n read_val_Fine = %d",read_val_Fine);
-
-
- if(mode == 1){
- //粗・微 調整判定
- float diffref_C = 0.000412 / 255 * read_val_Fine + 0.0032;
- float diffref_F = 0.000412 / 255 * read_val_Coarse + 0.000165;
- float diffcom = diffref_C * 1.5;
- //serial.printf("\r\n diffref_C = %f",diffref_C);
- //serial.printf("\r\n diffref_F = %f",diffref_F);
- //serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom){CorF = 2;} //粗
- else if(diff < diffcom){
- CorF = 1; //微
- if(diff < 0.001){break;}//差分微小 ループ2ブレイク(通常最終ゴール)
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2){val = diff / diffref_C;}
- else if(CorF == 1){val = diff / diffref_F;}
- serial.printf("\r\n tap(val) = %d",val);
- }
- else if(mode==2 || mode==3){
- if(CTrange == 0){ //60Aのとき
- //粗・微 調整判定
- float diffref_C = 0.001966 / 255 * read_val_Fine + 0.00885;
- float diffref_F = 0.001966 / 255 * read_val_Coarse + 0.000145;
- float diffcom = diffref_C * 1.5;
- serial.printf("\r\n diffref_C = %f",diffref_C);
- serial.printf("\r\n diffref_F = %f",diffref_F);
- serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom){CorF = 2;} //粗
- else if(diff < diffcom){
- CorF = 1; //微
- if(diff < 0.002){break;}//差分微小 ループ2ブレイク(通常最終ゴール)
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2){val = diff / diffref_C;}
- else if(CorF == 1){val = diff / diffref_F;}
- serial.printf("\r\n tap(val) = %d",val);
- }
- else if(CTrange == 1){ //120Aのとき
- //粗・微 調整判定
- float diffref_C = 0.000983 / 255 * read_val_Fine + 0.0044;
- float diffref_F = 0.000983 / 255 * read_val_Coarse + 0.0000993;
- float diffcom = diffref_C * 1.5;
- //serial.printf("\r\n diffref_C = %f",diffref_C);
- //serial.printf("\r\n diffref_F = %f",diffref_F);
- //serial.printf("\r\n diffcom = %f",diffcom);
- if(diff >= diffcom){CorF = 2;} //粗
- else if(diff < diffcom){
- CorF = 1; //微
- if(diff < 0.002){break;}//差分微小 ループ2ブレイク(通常最終ゴール)
- }
- serial.printf("\r\n CorF = %d",CorF);
-
- //調整tap値算出
- if(CorF == 2){val = diff / diffref_C;}
- else if(CorF == 1){val = diff / diffref_F;}
- serial.printf("\r\n tap(val) = %d",val);
- }
- }
- //ワイパー位置移動
- incdec(incr, val, CorF, mode);
-
- adjcount ++;
-
- } //ループ2
-
- if(mode==1){coilEN2 = 1;} //TRANS_OUTを外部出力へ切替え
- else if(mode==2 || mode==3){coilEN3 = 1; coilEN4 = 0;} //CT1_OUT1と2を外部出力へ切替え
-
- serial.printf("\r\n ADJ END");
-}
-
-void Vswitch(int a){
- coilEN5 = a;
serial.printf("\r\n OK");
}
-void Fswitch(int a){
- coilEN1 = a;
- serial.printf("\r\n OK");
-}
-void Tswitch(int a){
- coilEN2 = a;
+/*
+void GPIOXswitch(int tmpInt)
+{
+ GPIOX = tmpInt;
+ wait(0.01);
serial.printf("\r\n OK");
}
-void Cswitch(int a,int b){
- coilEN3 = a;
- coilEN4 = b;
- serial.printf("\r\n OK");
-}
-void Rswitch(int a){
- SCT_AMP = a;
- CTrange = a;
- serial.printf("\r\n OK");
-}
+*/
/******************************************************************************/
//シリアル入力受付 [メイン]
/******************************************************************************/
-void serial_inout(){
+void serial_inout()
+{
if(serial.readable()) { // 受信確認
- moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
- serial.printf("%c", moji[count]); //シリアル出力表示
+ moji[count] = serial.getc(); //キーボード入力文字を1文字ずつmojiに代入
+ serial.printf("%c", moji[count]); //シリアル出力表示
// serial.printf("%c(%d)", moji[count],count); //シリアル出力表示
-
- if(count == 31 ){ // ①文字数が既定の個数になった場合
- moji[31] = '\0'; // 末尾に終端文字を入れる
- count = 0; // 文字カウンタをリセット
- serial.printf("\r\n\r\n ERROR!");
+
+ if(count == 31 ) { // ①文字数が既定の個数になった場合
+ moji[31] = '\0'; // 末尾に終端文字を入れる
+ count = 0; // 文字カウンタをリセット
+ serial.printf("\r\n\r\n ERROR!");
}
- else if(moji[0] == '\n'){count = 0;}
-
+ else if(moji[0] == '\n') {
+ count = 0;
+ }
+
else if((moji[count] == '\r')) { // ②CRを受信した場合
moji[count] = '\0'; //末尾に終端文字を入れる
count = 0; //文字カウンタをリセット
- if (strcmp(moji, "cmd") == 0){helpwrite();} //コマンド一覧表示
- else if(strcmp(moji, "help") == 0){helpwrite();} //コマンド一覧表示
- else if(strcmp(moji, "?") == 0){helpwrite();} //コマンド一覧表示
- else if(strcmp(moji, "initial") == 0){initial();} //初期化
-
- else if(strcmp(moji, "V_OFF") == 0){Vswitch(0);} //±5V,±15Vオフ
- else if(strcmp(moji, "V_ON") == 0){Vswitch(1);} //±5V,±15Vオン
- else if(strcmp(moji, "50Hz") == 0){Fswitch(0);} //周波数切替
- else if(strcmp(moji, "60Hz") == 0){Fswitch(1);} //周波数切替
- else if(strcmp(moji, "TRANS_OUT_ADINT") == 0){Tswitch(0);} //TRANS_OUT内部AD入力
- else if(strcmp(moji, "TRANS_OUT_EXT") == 0){Tswitch(1);} //TRANS_OUT外部出力
- else if(strcmp(moji, "CT1_OUT_ADINT") == 0){Cswitch(0,0);} //CT1_OUT内部AD入力
- else if(strcmp(moji, "CT2_OUT_ADINT") == 0){Cswitch(0,1);} //CT2_OUT内部AD入力
- else if(strcmp(moji, "CT_OUT_EXT") == 0){Cswitch(1,0);} //CT1,2_OUT外部出力
- else if(strcmp(moji, "CTrange_60A") == 0){Rswitch(0);} //CT入力アンプゲイン60A
- else if(strcmp(moji, "CTrange_120A") == 0){Rswitch(0);} //CT入力アンプゲイン120A
-
- else if(strcmp(moji, "TRANS_offset") == 0){offsetcal(1);} //TRANS_OUT ADオフセット補正
- else if(strcmp(moji, "CT_offset") == 0){offsetcal(2);} //CT_OUT ADオフセット補正
-// else if(strcmp(moji, "CT2_offset") == 0){offsetcal(3);} //CT2_OUT ADオフセット補正
- else if(strcmp(moji, "dispVref") == 0){dispVref();} //各Vref表示
- else if(strcmp(moji, "TRANS_ADJ_100V") == 0){auto_adj(1,100);} //TRANS_OUTを設定
- else if(strcmp(moji, "CT1_ADJ_60A") == 0){auto_adj(2,60);} //CT1を設定
- else if(strcmp(moji, "CT2_ADJ_60A") == 0){auto_adj(3,60);} //CT2を設定
- else if(strcmp(moji, "TRANS_ADJ_MODE") == 0){auto_adj_mode(1);} //TRANS_OUT調整モードに移行
- else if(strcmp(moji, "CT1_ADJ_MODE") == 0){auto_adj_mode(2);} //CT1_OUT調整モードに移行
- else if(strcmp(moji, "CT2_ADJ_MODE") == 0){auto_adj_mode(3);} //CT2_OUT調整モードに移行
- else if(strcmp(moji, "MANUAL_TRANS_ADJ") == 0){manual_adj(1);} //TRANS_OUT手動調整モードに移行
- else if(strcmp(moji, "MANUAL_CT1_ADJ") == 0){manual_adj(2);} //CT1_OUT手動調整モードに移行
- else if(strcmp(moji, "MANUAL_CT2_ADJ") == 0){manual_adj(3);} //CT1_OU2手動調整モードに移行
-
- //デバッグ用
- else if(strcmp(moji, "TCON") == 0){TCON();}
- else if(strcmp(moji, "TCONread") == 0){TCONread();}
- else if(strcmp(moji, "read") == 0){read();}
- else if(strcmp(moji, "write00") == 0){write00();}
- else if(strcmp(moji, "write7F") == 0){write7F();}
- else if(strcmp(moji, "writeFF") == 0){writeFF();}
- else if(strcmp(moji, "WLAT") == 0){WLAT();}
- else if(strcmp(moji, "CS0") == 0){CS(0);}
- else if(strcmp(moji, "CS1") == 0){CS(1);}
- else if(strcmp(moji, "AD1") == 0){AD(1);}
- else if(strcmp(moji, "AD2") == 0){AD(2);}
- else if(strcmp(moji, "TENinc") == 0){TENinc();}
- else if(strcmp(moji, "att1") == 0){att(1);}
- else if(strcmp(moji, "att2") == 0){att(2);}
- else if(strcmp(moji, "att3") == 0){att(3);}
- else if(strcmp(moji, "det") == 0){det();}
- else if(strcmp(moji, "AD1_Vrms") == 0){ADVrms(1);}
- else if(strcmp(moji, "AD2_Vrms") == 0){ADVrms(2);}
- else if(strcmp(moji, "AD3_Vrms") == 0){ADVrms(3);}
- else if(strcmp(moji, "ADDR1") == 0){ADDR(1);}
- else if(strcmp(moji, "ADDR2") == 0){ADDR(2);}
- else if(strcmp(moji, "ADDR3") == 0){ADDR(3);}
- else if(strcmp(moji, "ADDR4") == 0){ADDR(4);}
- else if(strcmp(moji, "ADDR5") == 0){ADDR(5);}
- else if(strcmp(moji, "ADDR6") == 0){ADDR(6);}
-
-
- else serial.printf("\r\n\r\n NG!\r\n");
- }
- else count++; // 文字カウンタに1加算
+ if (strcmp(moji, "cmd") == 0) {
+ helpwrite(); //コマンド一覧表示
+ } else if(strcmp(moji, "help") == 0) {
+ helpwrite(); //コマンド一覧表示
+ } else if(strcmp(moji, "?") == 0) {
+ helpwrite(); //コマンド一覧表示
+ } else if(strcmp(moji, "relayALLoff") == 0) {
+ Vswitch(0);
+ } else if(strcmp(moji, "relay1") == 0) {
+ Vswitch(1);
+ } else if(strcmp(moji, "relay2") == 0) {
+ Vswitch(2);
+ } else if(strcmp(moji, "relay3") == 0) {
+ Vswitch(3);
+ } else if(strcmp(moji, "relay4") == 0) {
+ Vswitch(4);
+ } else if(strcmp(moji, "relay5") == 0) {
+ Vswitch(5);
+ } else if(strcmp(moji, "relay6") == 0) {
+ Vswitch(6);
+ } else if(strcmp(moji, "relay7") == 0) {
+ Vswitch(7);
+ } else if(strcmp(moji, "relay8") == 0) {
+ Vswitch(8);
+ } else if(strcmp(moji, "relay9") == 0) {
+ Vswitch(9);
+ } else if(strcmp(moji, "relay10") == 0) {
+ Vswitch(10);
+ } else if(strcmp(moji, "GPIO1L") == 0) {
+ GPIOswitch(1,0);
+ } else if(strcmp(moji, "GPIO1H") == 0) {
+ GPIOswitch(1,1);
+ } else if(strcmp(moji, "GPIO2L") == 0) {
+ GPIOswitch(2,0);
+ } else if(strcmp(moji, "GPIO2H") == 0) {
+ GPIOswitch(2,1);
+ } else if(strcmp(moji, "GPIO3L") == 0) {
+ GPIOswitch(3,0);
+ } else if(strcmp(moji, "GPIO3H") == 0) {
+ GPIOswitch(3,1);
+ } else if(strcmp(moji, "GPIO4L") == 0) {
+ GPIOswitch(4,0);
+ } else if(strcmp(moji, "GPIO4H") == 0) {
+ GPIOswitch(4,1);
+ } else if(strcmp(moji, "GPIO5L") == 0) {
+ GPIOswitch(5,0);
+ } else if(strcmp(moji, "GPIO5H") == 0) {
+ GPIOswitch(5,1);
+ } else if(strcmp(moji, "GPIO6L") == 0) {
+ GPIOswitch(6,0);
+ } else if(strcmp(moji, "GPIO6H") == 0) {
+ GPIOswitch(6,1);
+ } else if(strcmp(moji, "GPIO7L") == 0) {
+ GPIOswitch(7,0);
+ } else if(strcmp(moji, "GPIO7H") == 0) {
+ GPIOswitch(7,1);
+ } else if(strcmp(moji, "GPIO8L") == 0) {
+ GPIOswitch(8,0);
+ } else if(strcmp(moji, "GPIO8H") == 0) {
+ GPIOswitch(8,1);
+ } else if(strcmp(moji, "GPIO9L") == 0) {
+ GPIOswitch(9,0);
+ } else if(strcmp(moji, "GPIO9H") == 0) {
+ GPIOswitch(9,1);
+ } else if(strcmp(moji, "GPIO10L") == 0) {
+ GPIOswitch(10,0);
+ } else if(strcmp(moji, "GPIO10H") == 0) {
+ GPIOswitch(10,1);
+ } else if(strcmp(moji, "GPIO11L") == 0) {
+ GPIOswitch(11,0);
+ } else if(strcmp(moji, "GPIO11H") == 0) {
+ GPIOswitch(11,1);
+ } else if(strcmp(moji, "GPIO12L") == 0) {
+ GPIOswitch(12,0);
+ } else if(strcmp(moji, "GPIO12H") == 0) {
+ GPIOswitch(12,1);
+ } else if(strcmp(moji, "GPIO13L") == 0) {
+ GPIOswitch(13,0);
+ } else if(strcmp(moji, "GPIO13H") == 0) {
+ GPIOswitch(13,1);
+ } else if(strcmp(moji, "GPIO14L") == 0) {
+ GPIOswitch(14,0);
+ } else if(strcmp(moji, "GPIO14H") == 0) {
+ GPIOswitch(14,1);
+ } else if(strcmp(moji, "GPIO15L") == 0) {
+ GPIOswitch(15,0);
+ } else if(strcmp(moji, "GPIO15H") == 0) {
+ GPIOswitch(15,1);
+ } else if(strcmp(moji, "GPIO16L") == 0) {
+ GPIOswitch(16,0);
+ } else if(strcmp(moji, "GPIO16H") == 0) {
+ GPIOswitch(16,1);
+ } else if(strcmp(moji, "GPIO17L") == 0) {
+ GPIOswitch(17,0);
+ } else if(strcmp(moji, "GPIO17H") == 0) {
+ GPIOswitch(17,1);
+ } else if(strcmp(moji, "GPIO18L") == 0) {
+ GPIOswitch(18,0);
+ } else if(strcmp(moji, "GPIO18H") == 0) {
+ GPIOswitch(18,1);
+ } else if(strcmp(moji, "GPIO19L") == 0) {
+ GPIOswitch(19,0);
+ } else if(strcmp(moji, "GPIO19H") == 0) {
+ GPIOswitch(19,1);
+ } else if(strcmp(moji, "GPIO20L") == 0) {
+ GPIOswitch(20,0);
+ } else if(strcmp(moji, "GPIO20H") == 0) {
+ GPIOswitch(20,1);
+ } else if(strcmp(moji, "GPIOALLL") == 0) {
+ GPIOswitch(0,0);
+ } else if(strcmp(moji, "GPIOALLH") == 0) {
+ GPIOswitch(0,1);
+// } else if(strcmp(moji, "GPIOXH") == 0) {
+// GPIOXswitch(1);
+// } else if(strcmp(moji, "GPIOXL") == 0) {
+// GPIOXswitch(0);
+ } else serial.printf("\r\n\r\n NG!\r\n");
+ } else count++; // 文字カウンタに1加算
}
-}
+}
/******************************************************************************/
//メインプログラム
/******************************************************************************/
-int main() {
- pAVrefcal = &ActualVref[0];
- pmode = &mode_p;
- pCTrange = &CTrange;
-
- led1 = 1;
- wait(0.2);
- setup();
- initial();
- offsetcal(1);
- offsetcal(2);
-// offsetcal(3);
- auto_adj(1,100);
- auto_adj(2,60);
- auto_adj(3,60);
- coilEN2 = 1; //TRANS_OUT出力
- coilEN3 = 1; //CT1,2_OUT出力
- coilEN4 = 0;
- led1 = 0;
- serialstart();
-
-//*(volatile int *)0x4004402C = 0x2; // (レジスタ値を直接入力) アドレス0x4004402Cに値を代入
-//*(volatile int *)0x4004402C;
-//serial.printf( "data in 0x4004402C is 0x%08X\n", *(volatile int *)0x4004402C ); // アドレス0x4004402Cの値を表示
-
- while(1){
+int main()
+{
+ wait(0.5);
+ serial.printf("\r\nReady!\r\n");
+
+ while(1) {
serial_inout();
}
-
+
}
\ No newline at end of file