doppler shift / Mbed 2 deprecated Register_set_completed_1

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@0:4f081a382f9b, 2021-03-17 (annotated)

Committer:
KINU
Date:
Wed Mar 17 06:00:41 2021 +0000
Revision:
0:4f081a382f9b
Child:
1:515864d13410
mmm

Who changed what in which revision?

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