kinuko hayashi
/
Register_set_completed2
adf7021
main.cpp@0:a1b45e5da2af, 2021-02-06 (annotated)
- Committer:
- ryouheitakamoto
- Date:
- Sat Feb 06 05:55:53 2021 +0000
- Revision:
- 0:a1b45e5da2af
- Child:
- 1:58b02b3d2cb0
version 4
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ryouheitakamoto | 0:a1b45e5da2af | 1 | #include <mbed.h> |
ryouheitakamoto | 0:a1b45e5da2af | 2 | Serial pc(USBTX, USBRX,921600); |
ryouheitakamoto | 0:a1b45e5da2af | 3 | Serial device( p9, p10, 9600); |
ryouheitakamoto | 0:a1b45e5da2af | 4 | #define kHz 1000 |
ryouheitakamoto | 0:a1b45e5da2af | 5 | #define MHz 1000000 |
ryouheitakamoto | 0:a1b45e5da2af | 6 | LocalFileSystem local("local"); |
ryouheitakamoto | 0:a1b45e5da2af | 7 | |
ryouheitakamoto | 0:a1b45e5da2af | 8 | class calsat32 |
ryouheitakamoto | 0:a1b45e5da2af | 9 | { |
ryouheitakamoto | 0:a1b45e5da2af | 10 | public: |
ryouheitakamoto | 0:a1b45e5da2af | 11 | int Fractional_N; |
ryouheitakamoto | 0:a1b45e5da2af | 12 | int Integer_N; |
ryouheitakamoto | 0:a1b45e5da2af | 13 | int intbin[8]; |
ryouheitakamoto | 0:a1b45e5da2af | 14 | int decbin[15]; |
ryouheitakamoto | 0:a1b45e5da2af | 15 | int register_data;//レジスタへ入れるファイルから読み込んだ10進数の値 |
ryouheitakamoto | 0:a1b45e5da2af | 16 | int length; //値の長さ |
ryouheitakamoto | 0:a1b45e5da2af | 17 | int size;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る |
ryouheitakamoto | 0:a1b45e5da2af | 18 | int register_num;//レジスタ番号 |
ryouheitakamoto | 0:a1b45e5da2af | 19 | int buf; |
ryouheitakamoto | 0:a1b45e5da2af | 20 | |
ryouheitakamoto | 0:a1b45e5da2af | 21 | const char* filename; |
ryouheitakamoto | 0:a1b45e5da2af | 22 | FILE *fp; |
ryouheitakamoto | 0:a1b45e5da2af | 23 | |
ryouheitakamoto | 0:a1b45e5da2af | 24 | calsat32() |
ryouheitakamoto | 0:a1b45e5da2af | 25 | { |
ryouheitakamoto | 0:a1b45e5da2af | 26 | Fractional_N = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 27 | Integer_N = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 28 | register_data = 0;//レジスタへ入れる1ファイルから読み込んだ10進数の値 |
ryouheitakamoto | 0:a1b45e5da2af | 29 | length = 0; //値の長さ |
ryouheitakamoto | 0:a1b45e5da2af | 30 | size = 0;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る |
ryouheitakamoto | 0:a1b45e5da2af | 31 | register_num = 1;//レジスタ番号 |
ryouheitakamoto | 0:a1b45e5da2af | 32 | filename = "/local/register_set_1.txt"; |
ryouheitakamoto | 0:a1b45e5da2af | 33 | } |
ryouheitakamoto | 0:a1b45e5da2af | 34 | //main関数内でコマンドが0x00の時にmainでbinary()を呼ぶと計算をしてuint_32型の値を返す |
ryouheitakamoto | 0:a1b45e5da2af | 35 | |
ryouheitakamoto | 0:a1b45e5da2af | 36 | void Shift_bit(uint32_t& Register, int Register_data, int Size) |
ryouheitakamoto | 0:a1b45e5da2af | 37 | { |
ryouheitakamoto | 0:a1b45e5da2af | 38 | Register |= (Register_data << Size); |
ryouheitakamoto | 0:a1b45e5da2af | 39 | } |
ryouheitakamoto | 0:a1b45e5da2af | 40 | |
ryouheitakamoto | 0:a1b45e5da2af | 41 | void file_read(char* command) |
ryouheitakamoto | 0:a1b45e5da2af | 42 | { |
ryouheitakamoto | 0:a1b45e5da2af | 43 | /* ファイルのオープン */ |
ryouheitakamoto | 0:a1b45e5da2af | 44 | char name[100] = {};//出力はしない |
ryouheitakamoto | 0:a1b45e5da2af | 45 | if ((fp = fopen("/local/register.txt", "r")) == NULL) { |
ryouheitakamoto | 0:a1b45e5da2af | 46 | fprintf(stderr, "%sのオープンに失敗しました.\r\n", filename); |
ryouheitakamoto | 0:a1b45e5da2af | 47 | exit(EXIT_FAILURE); |
ryouheitakamoto | 0:a1b45e5da2af | 48 | } |
ryouheitakamoto | 0:a1b45e5da2af | 49 | |
ryouheitakamoto | 0:a1b45e5da2af | 50 | /* ファイルの終端まで文字を読み取り表示する */ |
ryouheitakamoto | 0:a1b45e5da2af | 51 | int l = 1;//行数 |
ryouheitakamoto | 0:a1b45e5da2af | 52 | uint32_t _register = 0;//最終的に欲しいレジスタの値.32ビット |
ryouheitakamoto | 0:a1b45e5da2af | 53 | while ( fscanf(fp,"%[^,],%d,%d%d",name, ®ister_data,&length,&buf) != EOF ) { |
ryouheitakamoto | 0:a1b45e5da2af | 54 | if(l == 1 || l == 9 || l == 19 || l == 24 || l == 31) continue; |
ryouheitakamoto | 0:a1b45e5da2af | 55 | printf("%d %d \r\n",register_data, length ); |
ryouheitakamoto | 0:a1b45e5da2af | 56 | //size += length; |
ryouheitakamoto | 0:a1b45e5da2af | 57 | l++; |
ryouheitakamoto | 0:a1b45e5da2af | 58 | //caalsatから受け取った値を格納するとき |
ryouheitakamoto | 0:a1b45e5da2af | 59 | if(register_num == 3 && size == 4 ) { |
ryouheitakamoto | 0:a1b45e5da2af | 60 | Shift_bit(_register, binary(command), 4); |
ryouheitakamoto | 0:a1b45e5da2af | 61 | size = 27; |
ryouheitakamoto | 0:a1b45e5da2af | 62 | } |
ryouheitakamoto | 0:a1b45e5da2af | 63 | |
ryouheitakamoto | 0:a1b45e5da2af | 64 | //テキストファイルから受け取った値を格納するとき |
ryouheitakamoto | 0:a1b45e5da2af | 65 | Shift_bit(_register, register_data, size); |
ryouheitakamoto | 0:a1b45e5da2af | 66 | |
ryouheitakamoto | 0:a1b45e5da2af | 67 | if(size == 32) { |
ryouheitakamoto | 0:a1b45e5da2af | 68 | //これで一つ完成.この値をどういう風にやるかは未定show()みたいなのを作るか? |
ryouheitakamoto | 0:a1b45e5da2af | 69 | show(_register); |
ryouheitakamoto | 0:a1b45e5da2af | 70 | size = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 71 | _register = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 72 | register_num++; |
ryouheitakamoto | 0:a1b45e5da2af | 73 | } |
ryouheitakamoto | 0:a1b45e5da2af | 74 | //printf("%s %d %d\n",name,register_data,length); |
ryouheitakamoto | 0:a1b45e5da2af | 75 | size += length; |
ryouheitakamoto | 0:a1b45e5da2af | 76 | |
ryouheitakamoto | 0:a1b45e5da2af | 77 | } |
ryouheitakamoto | 0:a1b45e5da2af | 78 | /* ファイルのクローズ */ |
ryouheitakamoto | 0:a1b45e5da2af | 79 | fclose(fp); |
ryouheitakamoto | 0:a1b45e5da2af | 80 | } |
ryouheitakamoto | 0:a1b45e5da2af | 81 | |
ryouheitakamoto | 0:a1b45e5da2af | 82 | uint32_t binary(char* command) |
ryouheitakamoto | 0:a1b45e5da2af | 83 | { |
ryouheitakamoto | 0:a1b45e5da2af | 84 | double num = doppler(command); |
ryouheitakamoto | 0:a1b45e5da2af | 85 | double n = num * 2 / 19.68; |
ryouheitakamoto | 0:a1b45e5da2af | 86 | Integer_N = (int)n; |
ryouheitakamoto | 0:a1b45e5da2af | 87 | double test = (n - (int)n); |
ryouheitakamoto | 0:a1b45e5da2af | 88 | Fractional_N = test*32768; |
ryouheitakamoto | 0:a1b45e5da2af | 89 | |
ryouheitakamoto | 0:a1b45e5da2af | 90 | //小数部分 |
ryouheitakamoto | 0:a1b45e5da2af | 91 | for(int i=0; Fractional_N>0; i++) { |
ryouheitakamoto | 0:a1b45e5da2af | 92 | decbin[i] = Fractional_N % 2; |
ryouheitakamoto | 0:a1b45e5da2af | 93 | Fractional_N = Fractional_N / 2; |
ryouheitakamoto | 0:a1b45e5da2af | 94 | } |
ryouheitakamoto | 0:a1b45e5da2af | 95 | int l = 15; |
ryouheitakamoto | 0:a1b45e5da2af | 96 | /*2進数の出力 |
ryouheitakamoto | 0:a1b45e5da2af | 97 | while( l>0 ) { |
ryouheitakamoto | 0:a1b45e5da2af | 98 | printf(" %d", decbin[--l]); |
ryouheitakamoto | 0:a1b45e5da2af | 99 | } |
ryouheitakamoto | 0:a1b45e5da2af | 100 | printf("\r\n"); |
ryouheitakamoto | 0:a1b45e5da2af | 101 | */ |
ryouheitakamoto | 0:a1b45e5da2af | 102 | uint32_t dec = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 103 | for(int i = 0; i < l; i++ ) { |
ryouheitakamoto | 0:a1b45e5da2af | 104 | dec |= (decbin[i] << i); |
ryouheitakamoto | 0:a1b45e5da2af | 105 | } |
ryouheitakamoto | 0:a1b45e5da2af | 106 | //整数部分 |
ryouheitakamoto | 0:a1b45e5da2af | 107 | for(int i = 0; Integer_N > 0; i++) { |
ryouheitakamoto | 0:a1b45e5da2af | 108 | intbin[i] = Integer_N % 2; |
ryouheitakamoto | 0:a1b45e5da2af | 109 | Integer_N = Integer_N / 2; |
ryouheitakamoto | 0:a1b45e5da2af | 110 | } |
ryouheitakamoto | 0:a1b45e5da2af | 111 | int k = 8; |
ryouheitakamoto | 0:a1b45e5da2af | 112 | /* |
ryouheitakamoto | 0:a1b45e5da2af | 113 | while( k>0 ) { |
ryouheitakamoto | 0:a1b45e5da2af | 114 | printf(" %d", intbin[--k]); |
ryouheitakamoto | 0:a1b45e5da2af | 115 | } |
ryouheitakamoto | 0:a1b45e5da2af | 116 | printf("\r\n"); |
ryouheitakamoto | 0:a1b45e5da2af | 117 | */ |
ryouheitakamoto | 0:a1b45e5da2af | 118 | uint32_t inte = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 119 | for(int i = 0; i < k; i++ ) { |
ryouheitakamoto | 0:a1b45e5da2af | 120 | inte |= (intbin[i] << i); |
ryouheitakamoto | 0:a1b45e5da2af | 121 | } |
ryouheitakamoto | 0:a1b45e5da2af | 122 | |
ryouheitakamoto | 0:a1b45e5da2af | 123 | return dec |= (inte << 15);//レジスタ入力に適した形にした23桁の2進数を返す |
ryouheitakamoto | 0:a1b45e5da2af | 124 | } |
ryouheitakamoto | 0:a1b45e5da2af | 125 | //データを取得し返す関数 |
ryouheitakamoto | 0:a1b45e5da2af | 126 | double doppler(char *a) |
ryouheitakamoto | 0:a1b45e5da2af | 127 | { |
ryouheitakamoto | 0:a1b45e5da2af | 128 | int data[10] = {0}; |
ryouheitakamoto | 0:a1b45e5da2af | 129 | double doppler_data = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 130 | int flag = 0; |
ryouheitakamoto | 0:a1b45e5da2af | 131 | for(int i = 5; i < 10; i++) { |
ryouheitakamoto | 0:a1b45e5da2af | 132 | char c = a[i]; |
ryouheitakamoto | 0:a1b45e5da2af | 133 | data[flag] = (c >> 4) & 0xf; |
ryouheitakamoto | 0:a1b45e5da2af | 134 | data[flag+1] = c & 0xf; |
ryouheitakamoto | 0:a1b45e5da2af | 135 | flag += 2; |
ryouheitakamoto | 0:a1b45e5da2af | 136 | } |
ryouheitakamoto | 0:a1b45e5da2af | 137 | |
ryouheitakamoto | 0:a1b45e5da2af | 138 | 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]; |
ryouheitakamoto | 0:a1b45e5da2af | 139 | printf("\n%lf\r\n",doppler_data / 1000000); |
ryouheitakamoto | 0:a1b45e5da2af | 140 | |
ryouheitakamoto | 0:a1b45e5da2af | 141 | return doppler_data / 1000000; |
ryouheitakamoto | 0:a1b45e5da2af | 142 | } |
ryouheitakamoto | 0:a1b45e5da2af | 143 | void show(uint32_t bin) |
ryouheitakamoto | 0:a1b45e5da2af | 144 | { |
ryouheitakamoto | 0:a1b45e5da2af | 145 | for(int i = 32; i > 0; i--) { |
ryouheitakamoto | 0:a1b45e5da2af | 146 | if(bin & (1 << (i - 1))) { |
ryouheitakamoto | 0:a1b45e5da2af | 147 | pc.printf("1"); |
ryouheitakamoto | 0:a1b45e5da2af | 148 | } else { |
ryouheitakamoto | 0:a1b45e5da2af | 149 | pc.printf("0"); |
ryouheitakamoto | 0:a1b45e5da2af | 150 | } |
ryouheitakamoto | 0:a1b45e5da2af | 151 | } |
ryouheitakamoto | 0:a1b45e5da2af | 152 | printf("\r\n"); |
ryouheitakamoto | 0:a1b45e5da2af | 153 | } |
ryouheitakamoto | 0:a1b45e5da2af | 154 | |
ryouheitakamoto | 0:a1b45e5da2af | 155 | }; |
ryouheitakamoto | 0:a1b45e5da2af | 156 | |
ryouheitakamoto | 0:a1b45e5da2af | 157 | int main() |
ryouheitakamoto | 0:a1b45e5da2af | 158 | { |
ryouheitakamoto | 0:a1b45e5da2af | 159 | while(1) { |
ryouheitakamoto | 0:a1b45e5da2af | 160 | char c = device.getc(); |
ryouheitakamoto | 0:a1b45e5da2af | 161 | if(c == 0xfe) { //FEコマンドがきたらdataが始まる |
ryouheitakamoto | 0:a1b45e5da2af | 162 | //printf("fe!!"); |
ryouheitakamoto | 0:a1b45e5da2af | 163 | char command[128] = {}; |
ryouheitakamoto | 0:a1b45e5da2af | 164 | while(1) { |
ryouheitakamoto | 0:a1b45e5da2af | 165 | command[0] = c; |
ryouheitakamoto | 0:a1b45e5da2af | 166 | int i = 1; |
ryouheitakamoto | 0:a1b45e5da2af | 167 | calsat32 a; |
ryouheitakamoto | 0:a1b45e5da2af | 168 | while(c != 0xfd) { |
ryouheitakamoto | 0:a1b45e5da2af | 169 | c = device.getc(); |
ryouheitakamoto | 0:a1b45e5da2af | 170 | command[i] = c; |
ryouheitakamoto | 0:a1b45e5da2af | 171 | i++; |
ryouheitakamoto | 0:a1b45e5da2af | 172 | } |
ryouheitakamoto | 0:a1b45e5da2af | 173 | for(int j = 0; j < i; j++) |
ryouheitakamoto | 0:a1b45e5da2af | 174 | printf("%02hhx",command[j]); |
ryouheitakamoto | 0:a1b45e5da2af | 175 | printf("\r\n"); |
ryouheitakamoto | 0:a1b45e5da2af | 176 | //ここまでで一旦プリアンブルからポストアンブルまでをcommandに格納する |
ryouheitakamoto | 0:a1b45e5da2af | 177 | if(command[4] == 0x00 ) |
ryouheitakamoto | 0:a1b45e5da2af | 178 | a.file_read(command); |
ryouheitakamoto | 0:a1b45e5da2af | 179 | break; |
ryouheitakamoto | 0:a1b45e5da2af | 180 | } |
ryouheitakamoto | 0:a1b45e5da2af | 181 | } |
ryouheitakamoto | 0:a1b45e5da2af | 182 | } |
ryouheitakamoto | 0:a1b45e5da2af | 183 | return 0; |
ryouheitakamoto | 0:a1b45e5da2af | 184 | } |