From 4998a75ada0489f427bcd9660f4e9f53ed045877 Mon Sep 17 00:00:00 2001
From: Mariano Alvira <mar@devl.org>
Date: Mon, 13 Apr 2009 18:19:13 -0400
Subject: [PATCH] this is working well

---
 tests/rftest-rx.c |  21 +++--
 tests/rftest-tx.c | 234 +++++++++++++++++++++++++++++++++++++++-------
 2 files changed, 210 insertions(+), 45 deletions(-)

diff --git a/tests/rftest-rx.c b/tests/rftest-rx.c
index 34721391b..0e16f7929 100644
--- a/tests/rftest-rx.c
+++ b/tests/rftest-rx.c
@@ -49,11 +49,14 @@ void magic(void) {
 
 uint32_t ackBox[10];
 
+#define MAX_PAYLOAD 128
+volatile uint8_t data[MAX_PAYLOAD];
+/* maca_rxlen is very important */
 #define command_xcvr_rx() \
 	do { \
-		maca_txlen = (uint32_t)1<<16;	\
+	maca_txlen = ((0xff)<<16); \
 		maca_dmatx = (uint32_t)&ackBox; \
-		maca_dmarx = DATA;		     \
+		maca_dmarx = data; \
 		maca_tmren = (maca_cpl_clk | maca_soft_clk);	      \
 		maca_control = (control_prm | control_asap | control_seq_rx); \
 	}while(FALSE)
@@ -95,7 +98,6 @@ void main(void) {
 	uint8_t c;
 	volatile uint32_t i;
 	uint32_t tmp;
-	volatile uint8_t *data;
 	uint16_t status;
 
 	*(volatile uint32_t *)GPIO_PAD_DIR0 = 0x00000200;
@@ -130,8 +132,7 @@ void main(void) {
         reg(MACA_CONTROL) = SMAC_MACA_CNTL_INIT_STATE;
 	for(i=0; i<DELAY; i++) { continue; }
 
-	data = (void *)DATA;
-	reg(MACA_DMARX) = DATA; /* put data somewhere */
+	reg(MACA_DMARX) = data; /* put data somewhere */
 	reg(MACA_PREAMBLE) = 0;
 
 /* 	puts("maca_base\n\r"); */
@@ -149,7 +150,6 @@ void main(void) {
 
 //	puts("\033[H\033[2J");
 	while(1) {		
-		uint32_t TsmRxSteps, LastWarmupStep, LastWarmupData, LastWarmdownStep, LastWarmdownData;
 
 		if(_is_action_complete_interrupt(maca_irq)) {
 			maca_clrirq = maca_irq;
@@ -209,11 +209,14 @@ void main(void) {
 				puts(" timestamp: 0x");
 				put_hex32(maca_timestamp);
 				puts("\n\r");
-				puts(" data: ");
-				for(i=0; i<reg(MACA_GETRXLVL); i++) {
+				puts(" data: 0x");
+				put_hex32(data);
+				putc(' ');
+				for(i=0; i<=(reg(MACA_GETRXLVL)-4); i++) { /* fcs+somethingelse is not transferred by DMA */
 					put_hex(data[i]);
 					putc(' ');
-				}
+				}				
+
 				puts("\n\r");
 
 				toggle_led();
diff --git a/tests/rftest-tx.c b/tests/rftest-tx.c
index d41916b13..fa6309142 100644
--- a/tests/rftest-tx.c
+++ b/tests/rftest-tx.c
@@ -9,6 +9,9 @@
 #define UART1_CTS       0x80005014
 #define UART1_BR        0x80005018
 
+#define GPIO_PAD_DIR0   0x80000000
+#define GPIO_DATA0      0x80000008
+
 #include "maca.h"
 #include "embedded_types.h"
 
@@ -17,6 +20,8 @@
 #define DELAY 400000
 #define DATA  0x00401000;
 
+#define NL "\033[K\r\n"
+
 void putc(uint8_t c);
 void puts(uint8_t *s);
 void put_hex(uint8_t x);
@@ -26,13 +31,97 @@ void put_hex32(uint32_t x);
 const uint8_t hex[16]={'0','1','2','3','4','5','6','7',
 		 '8','9','a','b','c','d','e','f'};
 
+void magic(void) {
+#define X     0x80009a000
+#define Y     0x80009a008
+#define VAL   0x0000f7df
+	volatile uint32_t x,y;
+	x = reg(X);      /* get X */
+	x &= 0xfffeffff; /* clear bit 16 */
+	reg(X) = x;      /* put it back  */
+	y = reg(Y);      /* get Y */
+	y |= VAL;        /* or with the VAL */
+	x = reg(X);      /* get X again */
+	x |= 16;         /* or with 16 */
+	reg(X) = x;      /* put X back */
+	reg(Y) = y;      /* put Y back */
+}
+
+uint32_t ackBox[10];
+
+#define command_xcvr_rx() \
+	do { \
+		maca_txlen = (uint32_t)1<<16;	\
+		maca_dmatx = (uint32_t)&ackBox; \
+		maca_dmarx = DATA;		     \
+		maca_tmren = (maca_cpl_clk | maca_soft_clk);	      \
+		maca_control = (control_prm | control_asap | control_seq_rx); \
+	}while(FALSE)
+
+#define PAYLOAD_LEN 16 /* not including the extra 4 bytes for len+fcs+somethingelse */
+/* maca dmatx needs extra 4 bytes for checksum */
+/* needs + 4 bytes for len(1 byte) + fcs(2 bytes) + somethingelse */
+#define command_xcvr_tx() \
+	do { \
+        maca_txlen = (uint32_t)(PAYLOAD_LEN+4); \ 
+        maca_dmatx = (uint32_t)DATA;					\
+        maca_dmarx = (uint32_t)&ackBox; \
+        maca_control = (control_prm | control_mode_no_cca | \
+                        control_asap | control_seq_tx); \
+	}while(FALSE)
+
+
+
+void dump_regs(uint32_t base, uint32_t len) {
+	volatile uint32_t i;
+    
+	puts("base +0       +4       +8       +c       +10      +14      +18      +1c      \n\r");                                                     
+	for (i = 0; i < len; i ++) {                                                                                                                   
+		if ((i & 7) == 0) {                                                                                                                   
+			put_hex16(4 * i);                                                                                                             
+		}                                                                                                                                     
+		puts(" ");                                                                                                                            
+		put_hex32(reg(base+(4*i)));                                                                                                      
+		if ((i & 7) == 7)                                                                                                                     
+			puts(NL);                                                                                                                     
+	}                                                                                                                                             
+	puts(NL); 
+}
+
+volatile uint8_t led;
+
+#define led_on() do  { led = 1; reg(GPIO_DATA0) = 0x00000100; } while(0);
+#define led_off() do { led = 0; reg(GPIO_DATA0) = 0x00000000; } while(0);
+
+void toggle_led(void) {
+	if(0 == led) {
+		led_on();
+		led = 1;
+
+	} else {
+		led_off();
+	}
+}
+
+volatile uint8_t *data;
+uint8_t count=0;
+void fill_data(void) {
+	uint8_t i;
+	for(i=0; i<PAYLOAD_LEN; i++) {
+		data[i] = count++;
+	}		
+}
+
 __attribute__ ((section ("startup")))
 void main(void) {
 	uint8_t c;
 	volatile uint32_t i;
-	volatile uint32_t *data;
 	uint32_t tmp;
+	uint16_t status;
 
+	*(volatile uint32_t *)GPIO_PAD_DIR0 = 0x00000100;
+	led_on();
+	
 	/* Restore UART regs. to default */
 	/* in case there is still bootloader state leftover */
 
@@ -50,54 +139,127 @@ void main(void) {
 	reg(UART1_CON) = 0x00000003; /* enable receive and transmit */
 	reg(GPIO_FUNC_SEL0) = ( (0x01 << (14*2)) | (0x01 << (15*2)) ); /* set GPIO15-14 to UART (UART1 TX and RX)*/
 
-	reg(80009000) = 0x00050100;
-
-	reg(MACA_RESET) = 0x3; /* reset, turn on the clock */
-	for(i=0; i<DELAY; i++) { continue; }
-	reg(MACA_RESET) = 0x2; /* unreset, turn on the clock */
-	for(i=0; i<DELAY; i++) { continue; }
-
+	reset_maca();
+	radio_init();
+	flyback_init();
+	vreg_init();
 	init_phy();
 
+	set_power(0x0f); /* 0dbm */
+	set_channel(0); /* channel 11 */
+
         reg(MACA_CONTROL) = SMAC_MACA_CNTL_INIT_STATE;
 	for(i=0; i<DELAY; i++) { continue; }
 
 	data = (void *)DATA;
-	data[0] = 0xabc0ffee;
-	maca_txlen = 1;
-	reg(MACA_DMATX) = DATA; /* get data from somewhere */
-	reg(MACA_PREAMBLE) = 0xface0fff;
-	
+	reg(MACA_DMARX) = DATA; /* put data somewhere */
+	reg(MACA_PREAMBLE) = 0;
 
-#define NL "\033[K\r\n"
+/* 	puts("maca_base\n\r"); */
+/* 	dump_regs(MACA_BASE, 96); */
+/* 	puts("modem write base\n\r"); */
+/* 	dump_regs(0x80009000, 96); */
+/* 	puts("modem read base\n\r"); */
+/* 	dump_regs(0x800091c0, 96); */
+/* 	puts("CRM\n\r"); */
+/* 	dump_regs(0x80003000, 96); */
+/* 	puts("reserved modem_base\n\r"); */
+/* 	dump_regs(0x80009200, 192); */
 
-	puts("\033[H\033[2J");
+	fill_data();
+	command_xcvr_tx();
+
+//	puts("\033[H\033[2J");
 	while(1) {		
-		puts("\033[H");
-		puts("rftest-tx --- " NL);
 
-		puts("base +0       +4       +8       +c       +10      +14      +18      +1c      " NL);
-		for (i = 0; i < 96; i ++) { 
-			if ((i & 7) == 0) {
-				put_hex16(4 * i);
+		if(_is_action_complete_interrupt(maca_irq)) {
+			maca_clrirq = maca_irq;
+			
+			status = reg(MACA_STATUS) & 0x0000ffff;
+			switch(status)
+			{
+			case(cc_aborted):
+			{
+				puts("aborted\n\r");
+				ResumeMACASync();				
+				break;
+				
 			}
-			putc(' ');
-			put_hex32(reg(MACA_BASE+(4*i)));
-			if ((i & 7) == 7)
-				puts(NL);
+			case(cc_not_completed):
+			{
+				puts("not completed\n\r");
+				ResumeMACASync();
+				break;
+				
+			}
+			case(cc_timeout):
+			{
+				puts("timeout\n\r");
+				ResumeMACASync();
+				break;
+				
+			}
+			case(cc_no_ack):
+			{
+				puts("no ack\n\r");
+				ResumeMACASync();
+				break;
+				
+			}
+			case(cc_ext_timeout):
+			{
+				puts("ext timeout\n\r");
+				ResumeMACASync();
+				break;
+				
+			}
+			case(cc_ext_pnd_timeout):
+			{
+				puts("ext pnd timeout\n\r");
+				ResumeMACASync();
+				break;
+				
+			}
+			case(cc_success):
+			{
+//				puts("success\n\r");
+				
+				puts("rftest-tx --- " );
+				puts(" payload len+crc: 0x");
+				put_hex(PAYLOAD_LEN+4);
+				puts(" timestamp: 0x");
+				put_hex32(maca_timestamp);
+				puts("\n\r");
+				puts(" data: ");
+				for(i=0; i<PAYLOAD_LEN; i++) {
+					put_hex(data[i]);
+					putc(' ');
+				}
+				puts("\n\r");
+
+				toggle_led();
+
+				fill_data();
+				command_xcvr_tx();
+				
+				break;
+				
+			}
+			default:
+			{
+				puts("status: ");
+				put_hex16(status);
+				ResumeMACASync();
+				
+			}
+			}
+		} else if (_is_filter_failed_interrupt(maca_irq)) {
+			puts("filter failed\n\r");
+			ResumeMACASync();
 		}
-		puts(NL);
-
-
-		/* start a sequence */
-		reg(MACA_CONTROL) = 0x00031A03;
-		/* wait for it to finish */
-		while (((tmp = reg(MACA_STATUS)) & 15) == 14)
-			continue;
-		puts("completed status is ");
-		put_hex32(tmp);
-		puts(NL);		
+		
 		for(i=0; i<DELAY; i++) { continue; }
+
 	};
 }