kinuko hayashi / Mbed 2 deprecated calsat32_9

なんかおかしい

Dependencies:   mbed

main.cpp@1:5e06e6104734, 2021-02-15 (annotated)

Committer:
KINU
Date:
Mon Feb 15 13:09:07 2021 +0000
Revision:
1:5e06e6104734
Parent:
0:890389640538 
aaaaaaaaaa

Who changed what in which revision?

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