なんかおかしい
Embed:
(wiki syntax)
Show/hide line numbers
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, ®ister_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 }
Generated on Mon Jul 18 2022 17:45:47 by
1.7.2