X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=shellcode%2Fchipcon%2Fcc1110%2Ftxpacket.c;h=87a37b740d133f89dd3885314c045b06651f07d2;hp=e41ce4906c0a4c452bb329026cec26296483b427;hb=d0498df7bc06959a19fe1ef2c4fc066dd8d68c92;hpb=77720e2680a4cda7305339510616cd707df423ba

diff --git a/shellcode/chipcon/cc1110/txpacket.c b/shellcode/chipcon/cc1110/txpacket.c
index e41ce49..87a37b7 100644
--- a/shellcode/chipcon/cc1110/txpacket.c
+++ b/shellcode/chipcon/cc1110/txpacket.c
@@ -3,9 +3,17 @@
 
 char __xdata at 0xfe00 packet[256] ;
 
+void sleepMillis(int ms) {
+	int j;
+	while (--ms > 0) { 
+		for (j=0; j<1200;j++); // about 1 millisecond
+	};
+}
+
 //! Transmit a packet out of the radio from 0xFE00.
 void main(){
   unsigned char len=packet[0], i=0;
+  long j;
   
   //Disable interrupts.
   RFTXRXIE=0;
@@ -18,12 +26,16 @@ void main(){
   RFST=RFST_STX;     //Begin transmit.
   while(MARCSTATE!=MARC_STATE_TX);
   
-  while(i!=len+1){
+  while(i<len+1){
     while(!RFTXRXIF); //Wait for byte to be ready.
-    
+    while(MARCSTATE!=MARC_STATE_TX); //Lockup if needed.
     RFTXRXIF=0;      //Clear the flag.
     RFD=packet[i++]; //Send the next byte.
   }
-  RFST = RFST_SIDLE; //End transmit.
+  
+  //Wait for transmission to complete.
+  while(MARCSTATE==MARC_STATE_TX);
+
+  //RFST = RFST_SIDLE; //End transmit.
   HALT;
 }