doppler shift / Mbed 2 deprecated Register_set_7

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:6c2706a07c9d, 2021-02-14 (annotated)

Committer:
ryouheitakamoto
Date:
Sun Feb 14 04:12:48 2021 +0000
Revision:
0:6c2706a07c9d
?;

Who changed what in which revision?

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