Revision:
5:dcbebd42186a
Parent:
4:844c00dd0366
Child:
6:e373216c80bf
--- a/X2D.cpp	Sun Nov 10 17:03:20 2019 +0000
+++ b/X2D.cpp	Sun Nov 10 17:40:07 2019 +0000
@@ -101,8 +101,8 @@
 
     DBG("Write_reg = %X",write_data);
     wait_posedge();   //find posedge for Tcr
-    Reg_Data = 1;   //set pin reg_data
-    RxTx = 0;   //clr pin rxtx
+    Reg_Data = 1;   //set pin reg_data to Register mode
+    RxTx = 0;       //set pin rxtx to Tx mode
   //  wait_negedge();
     //delay(50) ;       //delay for Tcc
 
@@ -111,18 +111,14 @@
         if(((write_data >> (23-i)) & 0x1) == 0)
         {
             Tx = 0;
-            //DBGc("0");
         }
         else
         {
             Tx = 1;
-            //DBGc("1");
         }
         wait_posedge();
-        //wait_negedge();
-        //wait_ms(32) ;                  //give enough hold time
     }
-    RxTx = 1;   //set pin rxtx
+    RxTx = 1;       //set pin rxtx to Rx
     Reg_Data = 0;   //set pin reg_data
     Tx = 0;
     wait(0.1);
@@ -130,20 +126,17 @@
 
 void SendBit(bool value)
 {
-//    pc.printf("%d ", value);
+//    DBG("%d ", value);
     Tx = !Tx;
     if(value)
         {
         wait_us(800);
-      //  pc.printf("%d, 800|", (int)Tx );
         Tx = !Tx;
         wait_us(800);
-      //  pc.printf("%d, 800|", (int)Tx);
         }
     else
         {
         wait_us(1600);
-      //  pc.printf("%d, 1600|", (int)Tx);
         }
 }
     
@@ -229,9 +222,6 @@
     tab[3] = dest;
     tab[6] = prog;
 
-    RxTx = 0;       //set pin rxtx to Tx
-    wait_ms(1);
-
     for(i=0; i<3; i++)
         {
         tab[5]=i;    //message count
@@ -239,7 +229,6 @@
         wait_ms(30);
         }
 
-    RxTx = 1;       //set pin rxtx to Rx
 }
 
 int detectPreamble(void)
@@ -398,9 +387,16 @@
 
 void Init_X2D()
 {
+int Ctrl_Reg = 0;
+
     Rx.fall(&getPulseF);
     Rx.rise(&getPulseR);
     UART = 1;
+
+    write_ctrl_reg(0x01E22F); // 1200 baud, deviation =1, Asynchrone
+    Ctrl_Reg = read_ctrl_reg();
+    DBG("Ctrl_reg = %X", Ctrl_Reg);
+
     RxTx = 1;       //set pin rxtx to Rx
     Reg_Data = 0;   //set pin reg_data 
     Tx = 0;