X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_mma655x.c;h=ce83a5a32054b4c1dde55dbb7c4060199b3d2c28;hb=7f6cbfac7c1965add91ebfc28ca3eac4561b4fb6;hp=005bc68461bb27d8fa146e51aa6b05970937e8c4;hpb=2cac8c572ce533ded89dae9a412b4d1b5c748342;p=fw%2Faltos

diff --git a/src/drivers/ao_mma655x.c b/src/drivers/ao_mma655x.c
index 005bc684..ce83a5a3 100644
--- a/src/drivers/ao_mma655x.c
+++ b/src/drivers/ao_mma655x.c
@@ -206,10 +206,7 @@ ao_mma655x_setup(void)
 	ao_mma655x_reg_write(AO_MMA655X_AXISCFG,
 			     AXISCFG_VALUE |
 			     (1 << AO_MMA655X_AXISCFG_ST));
-	for (i = 0; i < 10; i++) {
-		a_st = ao_mma655x_value();
-		printf ("SELF-TEST %2d = %6d\n", i, a_st);
-	}
+	a_st = ao_mma655x_value();
 
 	stdefl = ao_mma655x_reg_read(AO_MMA655X_STDEFL);
 
@@ -218,11 +215,6 @@ ao_mma655x_setup(void)
 			     (0 << AO_MMA655X_AXISCFG_ST));
 	a = ao_mma655x_value();
 
-	for (i = 0; i < 10; i++) {
-		a = ao_mma655x_value();
-		printf("NORMAL   %2d = %6d\n", i, a);
-	}
-
 	ao_mma655x_reg_write(AO_MMA655X_DEVCFG,
 			     DEVCFG_VALUE | (1 << AO_MMA655X_DEVCFG_ENDINIT));
 	s0 = ao_mma655x_reg_read(AO_MMA655X_SN0);
@@ -234,15 +226,14 @@ ao_mma655x_setup(void)
 	serial = lot & 0x1fff;
 	lot >>= 12;
 	pn = ao_mma655x_reg_read(AO_MMA655X_PN);
-	printf ("MMA655X lot %d serial %d number %d\n", lot, serial, pn);
-
 }
 
+uint16_t	ao_mma655x_current;
+
 static void
 ao_mma655x_dump(void)
 {
-	ao_mma655x_setup();
-	printf ("MMA655X value %d\n", ao_mma655x_value());
+	printf ("MMA655X value %d\n", ao_mma655x_current);
 }
 
 __code struct ao_cmds ao_mma655x_cmds[] = {
@@ -255,7 +246,7 @@ ao_mma655x(void)
 {
 	ao_mma655x_setup();
 	for (;;) {
-		ao_data_ring[ao_data_head].mma655x = ao_mma655x_value();
+		ao_mma655x_current = ao_mma655x_value();
 		ao_arch_critical(
 			AO_DATA_PRESENT(AO_DATA_MMA655X);
 			AO_DATA_WAIT();