doppler shift / Mbed 2 deprecated Register_set_5

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

main.cpp@1:58b02b3d2cb0, 2021-02-09 (annotated)

Committer:
KINU
Date:
Tue Feb 09 05:09:27 2021 +0000
Revision:
1:58b02b3d2cb0
Parent:
0:a1b45e5da2af 
kkk

Who changed what in which revision?

UserRevisionLine numberNew 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, &register_data,&length,&buf) != EOF ) {
KINU 1:58b02b3d2cb0 54 if(l == 1 || l == 9 || l == 19 || l == 24 || l == 31){
KINU 1:58b02b3d2cb0 55 printf("%d\n",l);
KINU 1:58b02b3d2cb0 56 l++;
KINU 1:58b02b3d2cb0 57
KINU 1:58b02b3d2cb0 58 }else{
ryouheitakamoto 0:a1b45e5da2af 59 printf("%d %d \r\n",register_data, length );
KINU 1:58b02b3d2cb0 60
KINU 1:58b02b3d2cb0 61 //calsatから受け取った値を格納するとき
ryouheitakamoto 0:a1b45e5da2af 62 if(register_num == 3 && size == 4 ) {
ryouheitakamoto 0:a1b45e5da2af 63 Shift_bit(_register, binary(command), 4);
ryouheitakamoto 0:a1b45e5da2af 64 size = 27;
ryouheitakamoto 0:a1b45e5da2af 65 }
ryouheitakamoto 0:a1b45e5da2af 66
ryouheitakamoto 0:a1b45e5da2af 67 //テキストファイルから受け取った値を格納するとき
ryouheitakamoto 0:a1b45e5da2af 68 Shift_bit(_register, register_data, size);
KINU 1:58b02b3d2cb0 69 size += length;
ryouheitakamoto 0:a1b45e5da2af 70 if(size == 32) {
ryouheitakamoto 0:a1b45e5da2af 71 //これで一つ完成.この値をどういう風にやるかは未定show()みたいなのを作るか？
KINU 1:58b02b3d2cb0 72 printf("regnum =%d ",register_num);
ryouheitakamoto 0:a1b45e5da2af 73 show(_register);
KINU 1:58b02b3d2cb0 74 register_num++;
KINU 1:58b02b3d2cb0 75 _register = 0;
ryouheitakamoto 0:a1b45e5da2af 76 size = 0;
KINU 1:58b02b3d2cb0 77 if(register_num == 5)
KINU 1:58b02b3d2cb0 78 size = 6;
KINU 1:58b02b3d2cb0 79
ryouheitakamoto 0:a1b45e5da2af 80 }
ryouheitakamoto 0:a1b45e5da2af 81 //printf("%s %d %d\n",name,register_data,length);
KINU 1:58b02b3d2cb0 82 //size += length; どこにおけばいいかわからん
KINU 1:58b02b3d2cb0 83 l++;
KINU 1:58b02b3d2cb0 84 }//else 閉じる
ryouheitakamoto 0:a1b45e5da2af 85 }
ryouheitakamoto 0:a1b45e5da2af 86 /* ファイルのクローズ */
ryouheitakamoto 0:a1b45e5da2af 87 fclose(fp);
ryouheitakamoto 0:a1b45e5da2af 88 }
ryouheitakamoto 0:a1b45e5da2af 89
ryouheitakamoto 0:a1b45e5da2af 90 uint32_t binary(char* command)
ryouheitakamoto 0:a1b45e5da2af 91 {
ryouheitakamoto 0:a1b45e5da2af 92 double num = doppler(command);
ryouheitakamoto 0:a1b45e5da2af 93 double n = num * 2 / 19.68;
ryouheitakamoto 0:a1b45e5da2af 94 Integer_N = (int)n;
ryouheitakamoto 0:a1b45e5da2af 95 double test = (n - (int)n);
ryouheitakamoto 0:a1b45e5da2af 96 Fractional_N = test*32768;
ryouheitakamoto 0:a1b45e5da2af 97
ryouheitakamoto 0:a1b45e5da2af 98 //小数部分
ryouheitakamoto 0:a1b45e5da2af 99 for(int i=0; Fractional_N>0; i++) {
ryouheitakamoto 0:a1b45e5da2af 100 decbin[i] = Fractional_N % 2;
ryouheitakamoto 0:a1b45e5da2af 101 Fractional_N = Fractional_N / 2;
ryouheitakamoto 0:a1b45e5da2af 102 }
ryouheitakamoto 0:a1b45e5da2af 103 int l = 15;
KINU 1:58b02b3d2cb0 104 //2進数の出力
ryouheitakamoto 0:a1b45e5da2af 105 while( l>0 ) {
ryouheitakamoto 0:a1b45e5da2af 106 printf(" %d", decbin[--l]);
ryouheitakamoto 0:a1b45e5da2af 107 }
ryouheitakamoto 0:a1b45e5da2af 108 printf("\r\n");
KINU 1:58b02b3d2cb0 109
ryouheitakamoto 0:a1b45e5da2af 110 uint32_t dec = 0;
ryouheitakamoto 0:a1b45e5da2af 111 for(int i = 0; i < l; i++ ) {
ryouheitakamoto 0:a1b45e5da2af 112 dec |= (decbin[i] << i);
ryouheitakamoto 0:a1b45e5da2af 113 }
ryouheitakamoto 0:a1b45e5da2af 114 //整数部分
ryouheitakamoto 0:a1b45e5da2af 115 for(int i = 0; Integer_N > 0; i++) {
ryouheitakamoto 0:a1b45e5da2af 116 intbin[i] = Integer_N % 2;
ryouheitakamoto 0:a1b45e5da2af 117 Integer_N = Integer_N / 2;
ryouheitakamoto 0:a1b45e5da2af 118 }
ryouheitakamoto 0:a1b45e5da2af 119 int k = 8;
KINU 1:58b02b3d2cb0 120
ryouheitakamoto 0:a1b45e5da2af 121 while( k>0 ) {
ryouheitakamoto 0:a1b45e5da2af 122 printf(" %d", intbin[--k]);
ryouheitakamoto 0:a1b45e5da2af 123 }
ryouheitakamoto 0:a1b45e5da2af 124 printf("\r\n");
KINU 1:58b02b3d2cb0 125
ryouheitakamoto 0:a1b45e5da2af 126 uint32_t inte = 0;
ryouheitakamoto 0:a1b45e5da2af 127 for(int i = 0; i < k; i++ ) {
ryouheitakamoto 0:a1b45e5da2af 128 inte |= (intbin[i] << i);
ryouheitakamoto 0:a1b45e5da2af 129 }
ryouheitakamoto 0:a1b45e5da2af 130
ryouheitakamoto 0:a1b45e5da2af 131 return dec |= (inte << 15);//レジスタ入力に適した形にした23桁の2進数を返す
ryouheitakamoto 0:a1b45e5da2af 132 }
ryouheitakamoto 0:a1b45e5da2af 133 //データを取得し返す関数
ryouheitakamoto 0:a1b45e5da2af 134 double doppler(char *a)
ryouheitakamoto 0:a1b45e5da2af 135 {
ryouheitakamoto 0:a1b45e5da2af 136 int data[10] = {0};
ryouheitakamoto 0:a1b45e5da2af 137 double doppler_data = 0;
ryouheitakamoto 0:a1b45e5da2af 138 int flag = 0;
ryouheitakamoto 0:a1b45e5da2af 139 for(int i = 5; i < 10; i++) {
ryouheitakamoto 0:a1b45e5da2af 140 char c = a[i];
ryouheitakamoto 0:a1b45e5da2af 141 data[flag] = (c >> 4) & 0xf;
ryouheitakamoto 0:a1b45e5da2af 142 data[flag+1] = c & 0xf;
ryouheitakamoto 0:a1b45e5da2af 143 flag += 2;
ryouheitakamoto 0:a1b45e5da2af 144 }
ryouheitakamoto 0:a1b45e5da2af 145
ryouheitakamoto 0:a1b45e5da2af 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];
ryouheitakamoto 0:a1b45e5da2af 147 printf("\n%lf\r\n",doppler_data / 1000000);
ryouheitakamoto 0:a1b45e5da2af 148
ryouheitakamoto 0:a1b45e5da2af 149 return doppler_data / 1000000;
ryouheitakamoto 0:a1b45e5da2af 150 }
ryouheitakamoto 0:a1b45e5da2af 151 void show(uint32_t bin)
ryouheitakamoto 0:a1b45e5da2af 152 {
ryouheitakamoto 0:a1b45e5da2af 153 for(int i = 32; i > 0; i--) {
ryouheitakamoto 0:a1b45e5da2af 154 if(bin & (1 << (i - 1))) {
ryouheitakamoto 0:a1b45e5da2af 155 pc.printf("1");
ryouheitakamoto 0:a1b45e5da2af 156 } else {
ryouheitakamoto 0:a1b45e5da2af 157 pc.printf("0");
ryouheitakamoto 0:a1b45e5da2af 158 }
ryouheitakamoto 0:a1b45e5da2af 159 }
ryouheitakamoto 0:a1b45e5da2af 160 printf("\r\n");
ryouheitakamoto 0:a1b45e5da2af 161 }
ryouheitakamoto 0:a1b45e5da2af 162
ryouheitakamoto 0:a1b45e5da2af 163 };
ryouheitakamoto 0:a1b45e5da2af 164
ryouheitakamoto 0:a1b45e5da2af 165 int main()
ryouheitakamoto 0:a1b45e5da2af 166 {
ryouheitakamoto 0:a1b45e5da2af 167 while(1) {
ryouheitakamoto 0:a1b45e5da2af 168 char c = device.getc();
ryouheitakamoto 0:a1b45e5da2af 169 if(c == 0xfe) { //FEコマンドがきたらdataが始まる
KINU 1:58b02b3d2cb0 170
ryouheitakamoto 0:a1b45e5da2af 171 char command[128] = {};
ryouheitakamoto 0:a1b45e5da2af 172 while(1) {
ryouheitakamoto 0:a1b45e5da2af 173 command[0] = c;
ryouheitakamoto 0:a1b45e5da2af 174 int i = 1;
ryouheitakamoto 0:a1b45e5da2af 175 calsat32 a;
ryouheitakamoto 0:a1b45e5da2af 176 while(c != 0xfd) {
ryouheitakamoto 0:a1b45e5da2af 177 c = device.getc();
ryouheitakamoto 0:a1b45e5da2af 178 command[i] = c;
ryouheitakamoto 0:a1b45e5da2af 179 i++;
ryouheitakamoto 0:a1b45e5da2af 180 }
ryouheitakamoto 0:a1b45e5da2af 181 for(int j = 0; j < i; j++)
ryouheitakamoto 0:a1b45e5da2af 182 printf("%02hhx",command[j]);
ryouheitakamoto 0:a1b45e5da2af 183 printf("\r\n");
ryouheitakamoto 0:a1b45e5da2af 184 //ここまでで一旦プリアンブルからポストアンブルまでをcommandに格納する
ryouheitakamoto 0:a1b45e5da2af 185 if(command[4] == 0x00 )
ryouheitakamoto 0:a1b45e5da2af 186 a.file_read(command);
ryouheitakamoto 0:a1b45e5da2af 187 break;
ryouheitakamoto 0:a1b45e5da2af 188 }
ryouheitakamoto 0:a1b45e5da2af 189 }
ryouheitakamoto 0:a1b45e5da2af 190 }
ryouheitakamoto 0:a1b45e5da2af 191 return 0;
ryouheitakamoto 0:a1b45e5da2af 192 }