ここまでは動く reg0_gen は使ってない

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include <mbed.h>
00002 #include <stdio.h>
00003 #include <stdlib.h>
00004 Serial pc(USBTX, USBRX,921600);
00005 Serial device( p9, p10, 9600);
00006 #define kHz 1000
00007 #define MHz 1000000
00008 #define PFD 19.68
00009 LocalFileSystem local("local");
00010 #pragma diag_suppress 870
00011 
00012 class calsat32
00013 {
00014 public:
00015     int Fractional_N;
00016     int Integer_N;
00017     int intbin[8];
00018     int decbin[15];
00019     int register_data;//レジスタへ入れるファイルから読み込んだ10進数の値
00020     int length; //値の長さ
00021     int size;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
00022     int register_num;//レジスタ番号
00023     int buf;
00024     char _command[128];
00025     double human_doppler; //人から受け取る周波数の値
00026     uint32_t _register;//最終的に欲しいレジスタの値.32ビット
00027     uint32_t register_data_array[16];//完成したレジスターを格納する配列sho
00028     const char* filename;
00029     FILE *fp;
00030 
00031     calsat32()
00032     {
00033         Fractional_N = 0;
00034         Integer_N = 0;
00035         register_data = 0;//レジスタへ入れる1ファイルから読み込んだ10進数の値
00036         length = 0; //値の長さ
00037         size = 0;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
00038         register_num = 1;//レジスタ番号
00039         filename = "/local/register.tsv";
00040         _register = 0;
00041         human_doppler = 0;
00042     }
00043     //main関数内でコマンドが0x00の時にmainでbinary()を呼ぶと計算をしてuint_32型の値を返す
00044 
00045     /*void Reg0_gen(int key,double doppler_data ){ //keyはコマンド
00046         if(key == 1) {
00047 
00048                Shift_bit(_register, binary(doppler_data), 4);
00049                size = 27;
00050            }
00051 
00052          else if(key ==2){ //calsatから受けとる
00053           Shift_bit(_register, binary(human_doppler), 4);//1の時calsat,2の時人
00054           size = 27;
00055          }
00056           else if(key == 3 || key == 0) {
00057                uint32_t tmp = 0;
00058                tmp |= ( register_data_array[2] >> 27); //この行と次の行でレジスタのデータの部分を全て0にしている
00059                tmp |= (tmp << 27);
00060                size = 27;
00061                if(key == 3){
00062                Shift_bit(tmp, binary(human_doppler), 4);//人間が入力した周波数の値を用いたレジスタを作成する
00063                register_data_array[2] = tmp;//配列の中に格納する
00064                show_all();
00065                }
00066 
00067            }else {}
00068     }*/
00069     void Shift_bit(uint32_t& Register, int Register_data, int Size)
00070     {
00071         Register |= (Register_data << Size);
00072     }
00073 
00074     void file_read(char* command,int key)
00075     {
00076         /* ファイルのオープン */
00077         char name[100] = {};//出力はしない
00078         if ((fp = fopen("/local/register.tsv", "r")) == NULL) {
00079             fprintf(stderr, "%sのオープンに失敗しました.\r\n", filename);
00080             exit(EXIT_FAILURE);
00081         }
00082 
00083         /* ファイルの終端まで文字を読み取り表示する */
00084         int num[5] = {1,3,0,5,4};
00085         int l = 1;//行数
00086         uint32_t _register = 0;//最終的に欲しいレジスタの値.32ビット
00087 
00088         while ( fscanf(fp,"%s%d%d%d",name, &register_data,&length,&buf) != EOF ) {
00089             if(l == 1 || l == 14  || l == 21 ||l == 27 || l == 37) {
00090                 printf("%d\r\n",l);
00091                 l++;
00092 
00093             } else {
00094                 printf(" %d %d   %d \r\n",register_data, length,size);
00095 
00096 
00097                 if(l==23) {
00098                         
00099                     Shift_bit(_register, binary(command), 4);
00100                     size = 27;
00101                     /* else if(key == 2){
00102                         human_doppler = register_data;
00103                        // Shift_bit(_register, binary(register_data), 4);
00104                     }
00105                        double doppler_data;
00106                         doppler_data = doppler(_command);
00107                       Reg0_gen(key,doppler_data);*/
00108 
00109                     //テキストファイルから受け取った値を格納するとき
00110                 } else {
00111                     Shift_bit(_register, register_data, size);
00112                     size += length;
00113 
00114                     if(register_num == 1 && size == 26) {
00115                         printf(" = reg_%d ",num[register_num - 1]);
00116                         show(_register);
00117                         register_num++;
00118                         _register = 0;
00119                         size = 0;
00120                     }
00121                     if(size == 32) {
00122                         //これで一つ完成.この値をどういう風にやるかは未定show()みたいなのを作るか?
00123                         printf(" = reg_%d ",num[register_num - 1]);
00124                         show(_register);
00125                         register_num++;
00126                         _register = 0;
00127                         size = 0;
00128                     }
00129                 }
00130                 l++;
00131             }
00132         }
00133 
00134         /* ファイルのクローズ */
00135         fclose(fp);
00136     }
00137 
00138     uint32_t binary(char* command)
00139     {
00140         double  RFout = doppler(command);
00141         double n = RFout * 2 / PFD;
00142         Integer_N = (int)n;
00143         double test = (n - (int)n);
00144         Fractional_N = test*32768;
00145 
00146         uint32_t data = Fractional_N;
00147         return data |= (Integer_N << 15);//レジスタ入力に適した形にした23桁の2進数を返す
00148     }
00149     //データを取得し返す関数
00150     double doppler(char *a)
00151     {
00152         int data[10] = {0};
00153         double doppler_data = 0;
00154         int flag = 0;
00155         for(int i = 5; i < 10; i++) {
00156             char c = a[i];
00157             data[flag] = (c >> 4) & 0xf;
00158             data[flag+1] = c & 0xf;
00159             flag += 2;
00160         }
00161 
00162         doppler_data = 10 * data[0] + data[1] + kHz * data[2] + 100 * data[3] + 100*kHz * data[4] + 10*kHz * data[5] + 10*MHz * data[6] + MHz * data[7] + data[8] + 100*MHz * data[9];//Hz
00163         printf("\n%lf\r\n",doppler_data / 1000000); //Mhz
00164 
00165         return doppler_data / 1000000;
00166     }
00167     void show(uint32_t bin)
00168     {
00169         static int reg_num = 0;
00170         //表示フェーズ
00171         for(int i = 32; i > 0; i--) {
00172             if(bin & (1 << (i - 1))) {
00173                 pc.printf("1");
00174             } else {
00175                 pc.printf("0");
00176             }
00177         }
00178         printf("\r\n");
00179 
00180         //格納フェーズ
00181         register_data_array[reg_num] = bin;
00182         reg_num++;
00183         if(reg_num == 4) {
00184             reg_num = 0;
00185         }
00186     }
00187 
00188     void show_all()//完成したレジスタの値を出力
00189     {
00190         for(int j = 0; j < 5; j++) {
00191             for(int i = 32; i > 0; i--) {
00192                 if(register_data_array[j] & (1 << (i - 1))) {
00193                     pc.printf("1");
00194                 } else {
00195                     pc.printf("0");
00196                 }
00197             }
00198             printf("\r\n");
00199         }
00200     }
00201     void packet(char c)
00202     {
00203         static int a = 0;
00204         _command[a] = c;
00205         a++;
00206 
00207         if(_command[a-1] == 0xfd) {
00208             /*
00209             for(int j = 0; j < a; j++)
00210                 printf("%02hhx",_command[j]);
00211             printf("\r\n");
00212             */
00213             a = 0;
00214 
00215         }
00216     }
00217 
00218     void check(char key)
00219 
00220     {
00221         printf("%c",key);
00222         if(_command[4] == 0x00) {
00223             printf("---------------------------Start-----------------------------\r\n");
00224             file_read(_command,key);
00225         }
00226     }
00227 
00228 };
00229 
00230 
00231 
00232 int main()
00233 {
00234     Serial device( p9, p10, 9600);
00235     while(1) {
00236         calsat32 tmp;
00237         while(device.readable()) {
00238             char c = device.getc();
00239             tmp.packet(c);
00240             if(pc.readable()) {
00241                 char key = pc.getc();
00242                 tmp.check(key);
00243             }
00244 
00245         }
00246     }
00247     return 0;
00248 }