![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
20210420_monitor
Dependencies: mbed SB1602E TextLCD MSCFILESytem FatFileSystemCpp
main.cpp@4:b9669a9feabd, 2022-05-23 (annotated)
- Committer:
- yayoi24
- Date:
- Mon May 23 03:08:57 2022 +0000
- Revision:
- 4:b9669a9feabd
- Parent:
- 3:d10c0110f1f0
moniter
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
yayoi24 | 4:b9669a9feabd | 1 | |
yayoi24 | 4:b9669a9feabd | 2 | //20210722モニタリングシステム kikkawa //積算発電積算消費 |
yayoi24 | 4:b9669a9feabd | 3 | |
yayoi24 | 4:b9669a9feabd | 4 | #include "mbed.h" // 必須 |
yayoi24 | 4:b9669a9feabd | 5 | #include "stdio.h" // ファイル操作 |
yayoi24 | 4:b9669a9feabd | 6 | #include "SB1602E.h" // デカ文字LCD |
yayoi24 | 4:b9669a9feabd | 7 | #include "TextLCD.h" // 4*20LCD |
yayoi24 | 4:b9669a9feabd | 8 | #include "MSCFileSystem.h" // USBメモリ |
yayoi24 | 4:b9669a9feabd | 9 | #include <string> // 文字列操作 |
MPPT51 | 1:93775378e5d9 | 10 | |
yayoi24 | 4:b9669a9feabd | 11 | /* タイマの設定 */ |
yayoi24 | 4:b9669a9feabd | 12 | Timer tm1; // タイマー時間の初期化(処理時間計測に使用) |
yayoi24 | 4:b9669a9feabd | 13 | Timer time0t5s; // main関数での処理に使用 |
yayoi24 | 4:b9669a9feabd | 14 | Timer time0t2s; // main関数での処理に使用 |
yayoi24 | 4:b9669a9feabd | 15 | |
yayoi24 | 4:b9669a9feabd | 16 | //Ticker tick; // 繰り返しタイマ割り込みの初期化 |
yayoi24 | 4:b9669a9feabd | 17 | TextLCD lcd1(p15,p16,p17,p18,p19,p20); // 4行LCDのポート設定(RS,E,DB4,DB5,DB6,DB7) |
yayoi24 | 4:b9669a9feabd | 18 | SB1602E lcd2(p28,p27); // デカ文字LCDのポート設定(SDA,SCL) |
yayoi24 | 4:b9669a9feabd | 19 | Serial pc(USBTX,USBRX); // USBシリアルポートの設定 |
yayoi24 | 4:b9669a9feabd | 20 | Serial im920(p13, p14); // p13(tx),p14(rx)をIM920とのシリアル通信ポートに設定 |
yayoi24 | 4:b9669a9feabd | 21 | CAN can(p30, p29); // CANのポート設定 |
MPPT51 | 0:78ab42fa3942 | 22 | |
yayoi24 | 4:b9669a9feabd | 23 | DigitalOut led1(LED1); // LPC1768ボード上1番目のLEDの設定 |
yayoi24 | 4:b9669a9feabd | 24 | DigitalOut led2(LED2); // LPC1768ボード上2番目のLEDの設定 |
yayoi24 | 4:b9669a9feabd | 25 | DigitalOut led3(LED3); // LPC1768ボード上3番目のLEDの設定 |
yayoi24 | 4:b9669a9feabd | 26 | DigitalOut led4(LED4); // LPC1768ボード上4番目のLEDの設定 |
yayoi24 | 4:b9669a9feabd | 27 | |
yayoi24 | 4:b9669a9feabd | 28 | /* 変数の宣言 */ |
yayoi24 | 4:b9669a9feabd | 29 | bool LED = 1; // 1のときLPC1768ボード上のLED(1~4)の点灯・点滅処理を実行. 0のとき点灯・点滅させない |
yayoi24 | 4:b9669a9feabd | 30 | int MPPTerror=0; // MPPT1のエラー信号を格納する変数 |
yayoi24 | 4:b9669a9feabd | 31 | int MPPTerror_2=0; // MPPT2のエラー信号を格納する変数 |
yayoi24 | 4:b9669a9feabd | 32 | int direc=0; // 進行方向(direction)を格納する変数 |
yayoi24 | 4:b9669a9feabd | 33 | float Vmot=0, Cmot=0, Pmot=0; // 消費電圧、電流、電力を格納する変数 |
yayoi24 | 4:b9669a9feabd | 34 | float Vsol=0, Csol=0, Psol=0; // 発電電圧・電流・電力を格納する変数 |
yayoi24 | 4:b9669a9feabd | 35 | float Vbat=0, Cbat=0, Pbat=0; // バッテリ電圧・電流・電力を格納する変数 |
yayoi24 | 4:b9669a9feabd | 36 | float VcelMax=0,VcelAve=0,VcelMin=0; // セル最大・平均・最小電圧を格納する変数 |
yayoi24 | 4:b9669a9feabd | 37 | float speed=0; // 走行速度を格納する変数 |
yayoi24 | 4:b9669a9feabd | 38 | signed char duty=0; // スロットル開度を格納する変数 |
yayoi24 | 4:b9669a9feabd | 39 | |
yayoi24 | 4:b9669a9feabd | 40 | int cntTera = 0; |
yayoi24 | 4:b9669a9feabd | 41 | |
yayoi24 | 4:b9669a9feabd | 42 | /* ユーザ定義関数の宣言 */ |
yayoi24 | 4:b9669a9feabd | 43 | void init(void); // 初期化を行う関数を宣言 |
yayoi24 | 4:b9669a9feabd | 44 | void printTera(void); // Teraterm表示を行う関数を宣言 |
yayoi24 | 4:b9669a9feabd | 45 | |
yayoi24 | 4:b9669a9feabd | 46 | //灯火類の設定 |
yayoi24 | 4:b9669a9feabd | 47 | /* |
yayoi24 | 4:b9669a9feabd | 48 | DigitalIn indiR_IN(p15); // 方向指示器(右)の入力の設定 |
yayoi24 | 4:b9669a9feabd | 49 | DigitalIn indiL_IN(p14); // 方向指示器(左)の入力の設定 |
yayoi24 | 4:b9669a9feabd | 50 | DigitalIn head_IN(p13); // ヘッドライトの入力の設定 |
yayoi24 | 4:b9669a9feabd | 51 | DigitalIn horn_IN(p12); // ホーンの入力の設定 |
yayoi24 | 4:b9669a9feabd | 52 | DigitalIn brake_IN(p11); // ブレーキランプの入力の設定 |
MPPT51 | 0:78ab42fa3942 | 53 | |
yayoi24 | 4:b9669a9feabd | 54 | PwmOut indiR_OUT(p20); // 方向指示器(右)の出力の設定 |
yayoi24 | 4:b9669a9feabd | 55 | PwmOut indiL_OUT(p19); // 方向指示器(左)の出力の設定 |
yayoi24 | 4:b9669a9feabd | 56 | PwmOut headt_OUT(p18); // ヘッドライトの出力の設定 |
yayoi24 | 4:b9669a9feabd | 57 | DigitalOut horn_OUT(p17); // ホーンの出力の設定 |
yayoi24 | 4:b9669a9feabd | 58 | DigitalOut brake_OUT(p16); // ブレーキランプの出力の設定 |
yayoi24 | 4:b9669a9feabd | 59 | */ |
yayoi24 | 4:b9669a9feabd | 60 | /* IM920(テレメトリ)の設定 */ |
yayoi24 | 4:b9669a9feabd | 61 | int cntIM920 = 0; |
yayoi24 | 4:b9669a9feabd | 62 | void printIM920(void); // PC(teraterm), IM920(テレメトリシステム), LCDへのprintf処理を行う関数 |
yayoi24 | 4:b9669a9feabd | 63 | |
yayoi24 | 4:b9669a9feabd | 64 | /* LCDの設定 */ |
yayoi24 | 4:b9669a9feabd | 65 | int cntLCD=0; |
yayoi24 | 4:b9669a9feabd | 66 | void printLCD(void); // LCDにデータ表示する関数 |
yayoi24 | 4:b9669a9feabd | 67 | |
yayoi24 | 4:b9669a9feabd | 68 | /* CAN通信の設定 */ |
yayoi24 | 4:b9669a9feabd | 69 | char cntCAN = 0; // CAN受信でカウントアップする変数 |
yayoi24 | 4:b9669a9feabd | 70 | CANMessage bufCAN; // CAN受信用バッファの初期化(バッファ(buf): データを一時的に格納するためのメモリー領域) |
yayoi24 | 4:b9669a9feabd | 71 | //void readCAN(void); |
yayoi24 | 4:b9669a9feabd | 72 | |
yayoi24 | 4:b9669a9feabd | 73 | /* USBメモリ(MSC:マスストレージクラス)の設定 */ |
yayoi24 | 4:b9669a9feabd | 74 | MSCFileSystem msc("usb"); // Mount flash drive under the name "usb" |
yayoi24 | 4:b9669a9feabd | 75 | char *str1 = "/usb/log"; // 保存先("usb")とファイル名の一部(log)を指定 |
yayoi24 | 4:b9669a9feabd | 76 | char *str2 = ".csv"; // ファイルの拡張子を指定 |
yayoi24 | 4:b9669a9feabd | 77 | char fileName[30]; // ファイル名を格納する配列 |
yayoi24 | 4:b9669a9feabd | 78 | char oxMSC; // 接続有無("o"か"x")を格納する変数(1文字用) |
yayoi24 | 4:b9669a9feabd | 79 | int cntMSC=0; // 処理を行うごとにカウントアップする変数 |
yayoi24 | 4:b9669a9feabd | 80 | void initMSC(void); // MSC(USB Mass Storage Class)の初期設定関数 |
yayoi24 | 4:b9669a9feabd | 81 | void saveMSC(void); // MSCへデータを書き込む関数 |
yayoi24 | 4:b9669a9feabd | 82 | FILE *fp2; // ファイル構造体の定義 |
yayoi24 | 4:b9669a9feabd | 83 | |
yayoi24 | 4:b9669a9feabd | 84 | void initMSC(){ // USBメモリの初期設定関数 |
yayoi24 | 4:b9669a9feabd | 85 | FILE *fp1; // ファイル構造体を定義 |
yayoi24 | 4:b9669a9feabd | 86 | int fileNumber = 0; // csvファイル命名に使用する変数を宣言 |
yayoi24 | 4:b9669a9feabd | 87 | |
yayoi24 | 4:b9669a9feabd | 88 | fp1 = fopen( "/usb/fileNumber.txt", "r" ); // USBメモリ内の"fileNumber.txt"を読み取りモードで開く |
yayoi24 | 4:b9669a9feabd | 89 | if( fp1 == NULL ){ // アクセスできなかったとき, ...error( "Could not open main0\n\r" );を入れても良い |
yayoi24 | 4:b9669a9feabd | 90 | pc.printf("USB init error\n\r" ); // teratermに"USB ini error"を表示 |
yayoi24 | 4:b9669a9feabd | 91 | oxMSC = 'x'; // MSCが接続されていないため"x"を格納(1文字なのでシングルクォーテーション) |
MPPT51 | 1:93775378e5d9 | 92 | } |
yayoi24 | 4:b9669a9feabd | 93 | else { // アクセスできたとき ...sbhost_lpc17xx.cppでの処理につながる |
yayoi24 | 4:b9669a9feabd | 94 | oxMSC = 'o'; // 1文字だからシングルクォーテーションで囲む |
yayoi24 | 4:b9669a9feabd | 95 | fscanf( fp1,"%d",&fileNumber ); // "fileNumber.txt"の数字を読み取り,変数"fileNumber"に格納する |
yayoi24 | 4:b9669a9feabd | 96 | fclose( fp1 ); // "fileNumber.txt"を閉じる |
yayoi24 | 4:b9669a9feabd | 97 | |
yayoi24 | 4:b9669a9feabd | 98 | fp1 = fopen( "/usb/fileNumber.txt", "w" ); // "fileNumber.txt"を書き込みモードで開く //exit(1);でBlueLightsOfDeath |
yayoi24 | 4:b9669a9feabd | 99 | fprintf( fp1,"%d\n", fileNumber+1 ); // 読み込んだ数値に+1してfileNumber.txtに書き込み |
yayoi24 | 4:b9669a9feabd | 100 | fclose(fp1); |
yayoi24 | 4:b9669a9feabd | 101 | |
yayoi24 | 4:b9669a9feabd | 102 | sprintf(fileName,"%s%d%s\n", str1, fileNumber, str2); // 文字列の結合(データログ用ファイル名の作成) |
yayoi24 | 4:b9669a9feabd | 103 | pc.printf( "\n\rUSB fileName: %s\n\r", fileName ); // 作成したファイル名をteratermに表示 |
yayoi24 | 4:b9669a9feabd | 104 | |
yayoi24 | 4:b9669a9feabd | 105 | fp2 = fopen( fileName, "w" ); // ファイルの新規作成後書き込み, ファイルがある場合上書き |
yayoi24 | 4:b9669a9feabd | 106 | if(fp2 != NULL){ // NULLじゃないとき(ファイルを開けた時) |
yayoi24 | 4:b9669a9feabd | 107 | fprintf( fp2,"Speed(km/h),dutyCycle,Vmot(V),Cmot(A),Pmot(W),Vsol(V),Csol(A),Psol(W),Vbat(V),Cbat(A),Pbat(W),VcelMax(V),VcelAve(V),VcelMin(V)\n" ); //ファイル書き込み |
yayoi24 | 4:b9669a9feabd | 108 | fclose(fp2); // csvファイル1行目にデータ項目を入力してファイルを閉じる |
yayoi24 | 4:b9669a9feabd | 109 | } |
MPPT51 | 0:78ab42fa3942 | 110 | } |
MPPT51 | 0:78ab42fa3942 | 111 | } |
yayoi24 | 4:b9669a9feabd | 112 | |
yayoi24 | 4:b9669a9feabd | 113 | void saveMSC(){ // 処理時間50ms以上(MBED Timerで計測,データ量による) |
yayoi24 | 4:b9669a9feabd | 114 | ++cntMSC; // MSCカウンタをインクリメント |
yayoi24 | 4:b9669a9feabd | 115 | if( cntMSC >= 255){ cntMSC = 0; } // 255になったらリセット |
yayoi24 | 4:b9669a9feabd | 116 | if( oxMSC == 'o' ){ |
yayoi24 | 4:b9669a9feabd | 117 | fp2 = fopen( fileName, "a"); // ファイルを上書きモードで開く(ファイルがなければ新規作成) |
yayoi24 | 4:b9669a9feabd | 118 | if ( fp2 == NULL ){ // ファイルを開けなかったとき, |
yayoi24 | 4:b9669a9feabd | 119 | oxMSC = 'x'; // MSCが接続されていないため"x"を格納(1文字なのでシングルクォーテーション) |
yayoi24 | 4:b9669a9feabd | 120 | }else { // USBメモリ内のファイルを開くことができたとき, |
yayoi24 | 4:b9669a9feabd | 121 | fprintf( fp2,"%5.1f,%3d,%5.1f,%5.1f,%6.1f,%5.1f,%5.1f,%6.1f,%5.1f,%5.1f,%6.1f,%5.3f,%5.3f,%5.3f\n", |
yayoi24 | 4:b9669a9feabd | 122 | speed, duty, Vmot, Cmot, Pmot, Vsol, Csol, Psol, Vbat, Cbat, Pbat, VcelMax, VcelAve, VcelMin ); |
yayoi24 | 4:b9669a9feabd | 123 | fclose(fp2); // データを書き込んだ後,ファイルを閉じる |
yayoi24 | 4:b9669a9feabd | 124 | pc.printf("MSC: %d\n", cntMSC); // |
yayoi24 | 4:b9669a9feabd | 125 | } |
yayoi24 | 3:d10c0110f1f0 | 126 | } |
yayoi24 | 4:b9669a9feabd | 127 | } |
yayoi24 | 4:b9669a9feabd | 128 | |
yayoi24 | 4:b9669a9feabd | 129 | void readCAN(){ // CANデータを受信したときに実行される関数(特定ID選択:https://os.mbed.com/questions/74230/about-ID-selectable-CAN-receive/, filter関数でも) |
yayoi24 | 4:b9669a9feabd | 130 | ++cntCAN; // CANカウンタをインクリメント |
yayoi24 | 4:b9669a9feabd | 131 | if( cntCAN >= 255 ){ cntCAN = 0; } // 255を超えたらリセット |
yayoi24 | 4:b9669a9feabd | 132 | |
yayoi24 | 4:b9669a9feabd | 133 | if( can.read(bufCAN) ){ // モタコンからデータが来たとき, |
yayoi24 | 4:b9669a9feabd | 134 | if( bufCAN.id == 0x20 ){ // MPPTからデータがきたとき, |
yayoi24 | 4:b9669a9feabd | 135 | if( LED ){ led2 = !led2; } // led2を点滅させる処理. !はNOTの意味 |
yayoi24 | 4:b9669a9feabd | 136 | Vsol = ( (float)( (bufCAN.data[0]*100) + bufCAN.data[1]) ) / 10; |
yayoi24 | 4:b9669a9feabd | 137 | Csol = ( (float)( (signed int)((signed char)bufCAN.data[2]*100) + (signed char)bufCAN.data[3] ) + ((signed char)bufCAN.data[6]*100) + (signed char)bufCAN.data[7] ) / 100; |
yayoi24 | 4:b9669a9feabd | 138 | MPPTerror = bufCAN.data[4]; |
yayoi24 | 4:b9669a9feabd | 139 | MPPTerror_2 = bufCAN.data[5]; |
yayoi24 | 4:b9669a9feabd | 140 | Psol = Vsol * Csol; |
yayoi24 | 4:b9669a9feabd | 141 | } |
yayoi24 | 4:b9669a9feabd | 142 | else if( bufCAN.id == 0x10 ){ |
yayoi24 | 4:b9669a9feabd | 143 | if( LED ){ led1 = !led1; } // led1を点滅させる(!はNOT) |
yayoi24 | 4:b9669a9feabd | 144 | Vmot = ( (float)( (bufCAN.data[0]*100) + bufCAN.data[1]) ) / 10; // 15 43を1500 43にして足すと「1543」となり、÷10すると154.3 [V] |
yayoi24 | 4:b9669a9feabd | 145 | Cmot = ( (float)( ((signed char)bufCAN.data[2]*100) + (signed char)bufCAN.data[3] ) ) / 100; |
yayoi24 | 4:b9669a9feabd | 146 | // 5 54を500 54にして足すと5「554」となり、÷100すると5.54 [A] |
yayoi24 | 4:b9669a9feabd | 147 | Pmot = Vmot * Cmot; |
yayoi24 | 4:b9669a9feabd | 148 | speed = ( (float)( (bufCAN.data[4]*100) + bufCAN.data[5]) ) / 10; //「856」を85.6[km/h]にするため,÷10する |
yayoi24 | 4:b9669a9feabd | 149 | duty = (signed char)bufCAN.data[6]; // アクセル開度は0~100表示のため,そのまま |
yayoi24 | 4:b9669a9feabd | 150 | direc = (int)bufCAN.data[7]; |
yayoi24 | 4:b9669a9feabd | 151 | } |
yayoi24 | 4:b9669a9feabd | 152 | |
yayoi24 | 4:b9669a9feabd | 153 | else if( bufCAN.id == 0x30 ){ // BMSからデータが来たとき, |
yayoi24 | 4:b9669a9feabd | 154 | if( LED ){ led3 = !led3; } // led3を点滅させる処理. !はNOTの意味 |
yayoi24 | 4:b9669a9feabd | 155 | Vbat = ( (float)( (bufCAN.data[0]*100) + bufCAN.data[1]) ) / 10; |
yayoi24 | 4:b9669a9feabd | 156 | Cbat = ( (float)( (signed int)((signed char)bufCAN.data[2]*100) + (signed char)bufCAN.data[3] ) ) / 100; |
yayoi24 | 4:b9669a9feabd | 157 | Pbat = Vbat * Cbat; |
yayoi24 | 4:b9669a9feabd | 158 | VcelMin = ( (float)( (bufCAN.data[4]*100) + bufCAN.data[5] ) ) / 100; |
yayoi24 | 4:b9669a9feabd | 159 | VcelMax = ( (float)( (bufCAN.data[6]*100) + bufCAN.data[7] ) ) / 100; |
yayoi24 | 4:b9669a9feabd | 160 | VcelAve = Vbat / 27; // バッテリ電圧をセルの直列数(20200807現在、27直列)で割って平均電圧を算出する |
yayoi24 | 4:b9669a9feabd | 161 | } |
yayoi24 | 4:b9669a9feabd | 162 | |
yayoi24 | 3:d10c0110f1f0 | 163 | } |
yayoi24 | 4:b9669a9feabd | 164 | } |
yayoi24 | 4:b9669a9feabd | 165 | void printLCD(){ // LCDにデータを表示する関数 |
yayoi24 | 4:b9669a9feabd | 166 | ++cntLCD; // IM920カウンタをインクリメント |
yayoi24 | 4:b9669a9feabd | 167 | if( cntLCD >= 255){ cntLCD = 0; } // 255以上でリセット |
yayoi24 | 4:b9669a9feabd | 168 | |
yayoi24 | 4:b9669a9feabd | 169 | lcd1.locate(0, 0); // 4行LCDの1行目1番目に表示位置を指定し, |
yayoi24 | 4:b9669a9feabd | 170 | lcd1.printf("%5.3fv %5.3fv %5.3fv", VcelMax, VcelAve, VcelMin); // バッテリセルの最大・平均・最小の電圧を表示 |
yayoi24 | 4:b9669a9feabd | 171 | lcd1.locate(0, 1); // 4行LCDの2行目1番目に表示位置を指定し, |
yayoi24 | 4:b9669a9feabd | 172 | lcd1.printf("B:%5.1fv%5.1fA%5.0fw", Vbat, Cbat, Pbat); // バッテリ電圧・電流・電力を表示 |
yayoi24 | 4:b9669a9feabd | 173 | lcd1.locate(0, 2); // 4行LCDの3行目1番目に表示位置を指定し, |
yayoi24 | 4:b9669a9feabd | 174 | lcd1.printf("M:%5.1fv%5.1fA d:%d", Vmot, Cmot, direc); // モータ電圧・電流, 進行方向を表示 |
yayoi24 | 4:b9669a9feabd | 175 | lcd1.locate(0, 3); // 4行LCDの4行目1番目に表示位置を指定し, |
yayoi24 | 4:b9669a9feabd | 176 | if( MPPTerror || MPPTerror_2 ){ // MPPTからエラー信号を受け取っていたとき, |
yayoi24 | 4:b9669a9feabd | 177 | if( MPPTerror ){ // MPPT1がエラーなら |
yayoi24 | 4:b9669a9feabd | 178 | lcd1.printf("S:X%2.1fv%5.1fA", Vsol, Csol); // 先頭に"X"を入れて発電電圧・電流を表示 |
yayoi24 | 4:b9669a9feabd | 179 | }else{ // MPPT2がエラーなら |
yayoi24 | 4:b9669a9feabd | 180 | lcd1.printf("S:XX%1.1fv%5.1fA", Vsol, Csol); // 先頭に"XX"を入れて発電電圧・電流を表示 |
yayoi24 | 4:b9669a9feabd | 181 | } |
yayoi24 | 4:b9669a9feabd | 182 | }else{ // MPPTからエラー信号を受け取っていないとき |
yayoi24 | 4:b9669a9feabd | 183 | lcd1.printf("S:%5.1fv%5.1fA", Vsol, Csol); // 発電電力・電流を表示 |
yayoi24 | 3:d10c0110f1f0 | 184 | } |
yayoi24 | 4:b9669a9feabd | 185 | lcd1.locate(15, 3); // 4行LCDの4行目16番目に表示位置を指定し, |
yayoi24 | 4:b9669a9feabd | 186 | lcd1.printf("USB:%c", oxMSC); // USBの接続状態を表示("o"か"x") |
yayoi24 | 4:b9669a9feabd | 187 | lcd2.printf( 0, "%5.1fkm/h %5.1fv\r", speed, Vmot ); // デカ文字LCDの1行目1番目に表示(速度,システム電圧) |
yayoi24 | 4:b9669a9feabd | 188 | lcd2.printf( 1, "%5.0fw %4.0fw %3d\r", Pmot, Psol, duty ); // デカ文字LCDの1行目2番目に表示(消費電力,発電電力,スロットル開度) |
yayoi24 | 4:b9669a9feabd | 189 | pc.printf("LCD:%d\n",cntLCD); // 無線送信処理を行ったことをPC(teraterm)へ知らせる |
yayoi24 | 4:b9669a9feabd | 190 | } |
yayoi24 | 4:b9669a9feabd | 191 | |
yayoi24 | 4:b9669a9feabd | 192 | void printIM920(){ // 処理時間16ms~(MBED Timerで計測) |
yayoi24 | 4:b9669a9feabd | 193 | ++cntIM920; // IM920カウンタをインクリメント |
yayoi24 | 4:b9669a9feabd | 194 | if( cntIM920 >= 255 ){ cntIM920 = 0; } // 255以上でリセット |
yayoi24 | 4:b9669a9feabd | 195 | im920.printf("TXDA%.1f,%.3f,%.3f,%.3f,%.1f,%.1f,%.1f,%.1f,%d,%d\r", |
yayoi24 | 4:b9669a9feabd | 196 | Vmot, VcelMax, VcelAve, VcelMin, Cbat, Cmot, Csol, speed, duty, cntIM920); |
yayoi24 | 4:b9669a9feabd | 197 | // TXDAに続く文字が無線送信される. データ間を","で区切る. 最後に"\r"必須 |
yayoi24 | 4:b9669a9feabd | 198 | pc.printf("IM920:%d\n",cntIM920); // 無線送信処理を行ったことをPC(teraterm)へ知らせる |
MPPT51 | 1:93775378e5d9 | 199 | } |
yayoi24 | 4:b9669a9feabd | 200 | |
yayoi24 | 4:b9669a9feabd | 201 | void printTera(){ |
yayoi24 | 4:b9669a9feabd | 202 | ++cntTera; // Teratermカウンタをインクリメント |
yayoi24 | 4:b9669a9feabd | 203 | if( cntTera >= 255){ cntTera = 0; } // 255以上でリセット |
yayoi24 | 4:b9669a9feabd | 204 | //pc.printf("Tera:%d\n",cntTera); // 無線送信処理を行ったことをPC(teraterm)へ知らせる |
yayoi24 | 4:b9669a9feabd | 205 | pc.printf("SP:%.1f DT:%d Vm:%.1f Im:%.2f Pm:%.1f Vs:%.1f Is: %.2f Ps:%.1f\n\r", speed, duty, Vmot, Cmot, Pmot, Vsol, Csol, Psol ); |
yayoi24 | 4:b9669a9feabd | 206 | pc.printf("Vb:%.1f Cb:%.2f Pb:%.1f max:%.3f avg:%.3f min:%.3f\n\r", Vbat, Cbat, Pbat, VcelMax, VcelAve, VcelMin ); |
MPPT51 | 0:78ab42fa3942 | 207 | } |
yayoi24 | 4:b9669a9feabd | 208 | |
yayoi24 | 4:b9669a9feabd | 209 | void init(){ // 初期化(初期設定)を行う関数 |
yayoi24 | 4:b9669a9feabd | 210 | pc.baud(115200); // pcとのシリアル通信ボーレートを115200bpsに設定(数字が大きい方が通信速度高い) |
yayoi24 | 4:b9669a9feabd | 211 | pc.printf("main() start\n"); |
yayoi24 | 4:b9669a9feabd | 212 | wait(3); // MBED電源投入から安定するまで3秒待つ(待たないと電源再投入後にUSBメモリの初期化・ファイル作成ができない) |
yayoi24 | 4:b9669a9feabd | 213 | im920.baud(19200); // IM920とのシリアル通信ボーレートを19200bpsに設定(19200はIM920の初期値) |
yayoi24 | 4:b9669a9feabd | 214 | initMSC(); // USBマスストレージクラス(USBメモリ)を初期化する関数を実行 |
yayoi24 | 4:b9669a9feabd | 215 | } |
yayoi24 | 4:b9669a9feabd | 216 | |
MPPT51 | 0:78ab42fa3942 | 217 | int main() { |
yayoi24 | 4:b9669a9feabd | 218 | init(); // 初期化関数を実行 |
yayoi24 | 4:b9669a9feabd | 219 | |
yayoi24 | 4:b9669a9feabd | 220 | MPPTerror_2 = 0; |
yayoi24 | 4:b9669a9feabd | 221 | Vmot=0; |
yayoi24 | 4:b9669a9feabd | 222 | Cmot=0; |
yayoi24 | 4:b9669a9feabd | 223 | Pbat=0; |
MPPT51 | 0:78ab42fa3942 | 224 | |
yayoi24 | 4:b9669a9feabd | 225 | tm1.start(); |
yayoi24 | 4:b9669a9feabd | 226 | time0t5s.start(); //https://os.mbed.com/media/uploads/yueee_yt/text_h24csee.pdf(p.21) |
yayoi24 | 4:b9669a9feabd | 227 | time0t2s.start(); //https://os.mbed.com/media/uploads/yueee_yt/text_h24csee.pdf(p.21) |
yayoi24 | 4:b9669a9feabd | 228 | |
yayoi24 | 4:b9669a9feabd | 229 | can.attach(&readCAN, CAN::RxIrq); //CAN受信割り込みの設定 |
MPPT51 | 0:78ab42fa3942 | 230 | while(1) { |
yayoi24 | 4:b9669a9feabd | 231 | //readLights(); |
yayoi24 | 4:b9669a9feabd | 232 | if( time0t5s.read() < 0.5 ){ |
yayoi24 | 4:b9669a9feabd | 233 | //readCAN(); // CANデータを読み込む関数を実行 |
yayoi24 | 4:b9669a9feabd | 234 | if( time0t2s.read() >= 0.2 ){ |
yayoi24 | 4:b9669a9feabd | 235 | time0t2s.reset(); // time0t2sをリスタートさせる |
yayoi24 | 4:b9669a9feabd | 236 | printLCD(); // LCDの表示を更新する関数を実行 |
yayoi24 | 4:b9669a9feabd | 237 | printTera(); // Teratermに表示する関数を実行 |
MPPT51 | 1:93775378e5d9 | 238 | } |
yayoi24 | 4:b9669a9feabd | 239 | } |
yayoi24 | 4:b9669a9feabd | 240 | if( time0t5s.read() >= 0.5 ){ // 0.5秒毎に実行する処理 |
yayoi24 | 4:b9669a9feabd | 241 | time0t5s.reset(); // time0t5sをリスタートさせる |
yayoi24 | 4:b9669a9feabd | 242 | if( LED ){ led4 = !led4; } // led4を点滅させる(!はNOT) |
yayoi24 | 4:b9669a9feabd | 243 | pc.printf("TheTime: %d(us)\n", tm1.read_us()); // 処理時間確認用プログラム(1/2) |
yayoi24 | 4:b9669a9feabd | 244 | tm1.reset(); // 処理時間確認用プログラム(2/2) |
yayoi24 | 4:b9669a9feabd | 245 | saveMSC(); // MSCにデータを保存する関数を実行 |
yayoi24 | 4:b9669a9feabd | 246 | printIM920(); // IM920に無線送信させる関数を実行 |
MPPT51 | 2:14b832fdd69f | 247 | } |
yayoi24 | 4:b9669a9feabd | 248 | |
MPPT51 | 0:78ab42fa3942 | 249 | } |
yayoi24 | 4:b9669a9feabd | 250 | } |