ここまでは動く reg0_gen は使ってない
Embed:
(wiki syntax)
Show/hide line numbers
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, ®ister_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 }
Generated on Mon Aug 15 2022 14:37:24 by
1.7.2