なんかおかしい

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

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