doppler shift / Mbed 2 deprecated Register_set_14

Dependencies:   mbed

Files at this revision

API Documentation at this revision

Comitter:
KINU
Date:
Wed Mar 03 05:40:33 2021 +0000
Parent:
0:4a39f09f6a55
Commit message:
hhh

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Sat Feb 27 08:43:34 2021 +0000
+++ b/main.cpp	Wed Mar 03 05:40:33 2021 +0000
@@ -1,6 +1,5 @@
 #include <mbed.h>
 Serial pc(USBTX, USBRX,921600);
-Serial device( p9, p10, 9600);
 #define kHz 1000
 #define MHz 1000000
 #define PFD 19.68
@@ -13,7 +12,7 @@
 {
 public:
     char _command[128];
-    calsat32(){}
+    calsat32() {}
     //main関数内でコマンドが0x00の時にmainでbinary()を呼ぶと計算をしてuint_32型の値を返す
     //データを取得し返す関数
     double doppler(char *a)
@@ -27,73 +26,75 @@
             data[flag+1] = c & 0xf;
             flag += 2;
         }
- 
+
         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
         printf("\n%lf\r\n",doppler_data / 1000000); //Mhz
-        
+
         return doppler_data / 1000000;
     }
-    
+
     double packet(char c)
     {
         double f = 0;
         static int a = 0;
         _command[a] = c;
         a++;
-        
+
         if(_command[a-1] == 0xfd) {
-            /*
+
             for(int j = 0; j < a; j++)
                 printf("%02hhx",_command[j]);
             printf("\r\n");
-            */
-            a = 0;
+
+            a = 0; //あとでここ消してやってみる
             if(_command[4] == 0x00) {
                 printf("---------------------------Start-----------------------------\r\n");
-                
+
                 double f = doppler(_command);
-                printf("%lf\n",f); 
+                //printf("%lf\n",f);
                 //file_read(_command);
             }
         }
         return f;
     }
- 
+
 };
 
-class Register_set {
- public:
- int register_data;//レジスタへ入れるファイルから読み込んだ10進数の値
- int register_num;//レジスタ番号
- int buf;
- const char* filename;
- FILE *fp;
+class Register_set
+{
+public:
+    int register_data;//レジスタへ入れるファイルから読み込んだ10進数の値
+    int register_num;//レジスタ番号
+    int buf;
+    const char* filename;
+    FILE *fp;
 
- int Fractional_N;
- int Integer_N;
- //int intbin[8];
- //int decbin[15];
- int length; //値の長さ
- int size;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
+    int Fractional_N;
+    int Integer_N;
+//int intbin[8];
+//int decbin[15];
+    int length; //値の長さ
+    int size;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
 
- Register_set (){
-   register_data = 0;//レジスタへ入れる1ファイルから読み込んだ10進数の値
-   register_num = 1;//レジスタ番号
-   filename = "/local/register.txt";
-   Fractional_N = 0;
-   Integer_N = 0;
-   length = 0; //値の長さ
-   size = 0;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
-             
- };
- uint32_t binary(double doppler_data)
+    Register_set ()
+    {
+        register_data = 0;//レジスタへ入れる1ファイルから読み込んだ10進数の値
+        register_num = 1;//レジスタ番号
+        filename = "/local/register.txt";
+        Fractional_N = 0;
+        Integer_N = 0;
+        length = 0; //値の長さ
+        size = 0;//累計の長さこれが32となったら1つのレジスタの設定が完了として次のレジスタの設定へ移る
+
+    }
+    uint32_t binary(double doppler_data)
     {
         double  RFout = doppler_data;
         double n = RFout * 2 / PFD;
         Integer_N = (int)n;
         double test = (n - (int)n);
         Fractional_N = test*32768;
- 
+
         uint32_t data = Fractional_N;
         return data |= (Integer_N << 15);//レジスタ入力に適した形にした23桁の2進数を返す
     }
@@ -105,7 +106,7 @@
             fprintf(stderr, "%sのオープンに失敗しました.\r\n", filename);
             exit(EXIT_FAILURE);
         }
- 
+
         /* ファイルの終端まで文字を読み取り表示する */
         int num[5] = {1,3,0,5,4};
         int l = 1;//行数
@@ -113,16 +114,16 @@
         while ( fscanf(fp,"%[^,],%d,%d%d",name, &register_data,&length,&buf) != EOF ) {
             if(l == 1 || l == 14 || l == 21 || l == 26 || l == 36)
                 l++;
- 
+
             else {
                 printf("%d %d \r\n",register_data, length );
- 
+
                 //レジスタ0にcalsatから受け取った値を格納するとき
                 if(register_num == 3 && size == 4 ) {
                     Shift_bit(_register, binary(doppler_data), 4);
                     size = 27;
                 }
- 
+
                 //テキストファイルから受け取った値を格納するとき
                 Shift_bit(_register, register_data, size);
                 size += length;
@@ -140,7 +141,7 @@
                     register_num++;
                     _register = 0;
                     size = 0;
- 
+
                 }
                 //printf("%s %d %d\n",name,register_data,length);
                 l++;
@@ -149,7 +150,7 @@
         /* ファイルのクローズ */
         fclose(fp);
     }
-     void Shift_bit(uint32_t& Register, int Register_data, int size)
+    void Shift_bit(uint32_t& Register, int Register_data, int size)
     {
         Register |= (Register_data << size);
     }
@@ -163,33 +164,36 @@
             }
         }
         printf("\r\n");
-    }  
+    }
 };
- 
+
 int main()
 {
     Serial device( p9, p10, 9600);
-    while(1){
-    printf(">>>");
-    double com;
-    scanf("%lf",&com);
-    printf("%lf\n",com);
-    if(com == 0.000000){ //calsatから周波数を受け取る
-     calsat32 tmp;
-        while(device.readable()) {
-            char c = device.getc();
-            doppler_data = tmp.packet(c);
-            if(doppler_data!=0)
-             break;
+    while(1) {
+        int com;
+        printf("input 0 or 1 >>>"); //0ならcalsatから受信、1なら人が入力
+
+        scanf("%d",&com);
+        printf("%d\r\n",com);
+        if(com == 0) { //calsatから周波数を受け取る
+            calsat32 tmp;
+            while(device.readable()) {
+                char c = device.getc();
+                doppler_data = tmp.packet(c);
+                printf("%lf\n",doppler_data);
+                if(doppler_data!=0)
+                    break;
+            }
+        } else {  //人が周波数を入力
+            printf("input frequency >>>");
+            scanf("%lf\n",&doppler_data);
+            printf("%lf\n",doppler_data);
         }
-    }else{//人が周波数を入力
-     doppler_data = com;
-     }  
-    
-    Register_set x;
-    x.file_read(doppler_data);
-    
- }
+
+        Register_set x;
+        x.file_read(doppler_data);
+
+    }
     return 0;
 }
- 
\ No newline at end of file