Committed.

### Eclipse Workspace Patch 1.0
#P openocd
Index: src/target/arm9tdmi.c
===================================================================
--- src/target/arm9tdmi.c       (revision 1643)
+++ src/target/arm9tdmi.c       (working copy)
@@ -283,34 +283,25 @@
        fields[0].tap = jtag_info->tap;
        fields[0].num_bits = 32;
        fields[0].out_value = NULL;
-
-       fields[0].in_value = NULL;
-       fields[0].in_handler = arm_jtag_buf_to_u32; /* deprecated! invoke
this from user code! */
-       fields[0].in_handler_priv = in;
-
-
+       u8 tmp[4];
+       fields[0].in_value = tmp;
+       fields[0].in_handler = NULL;

        fields[1].tap = jtag_info->tap;
        fields[1].num_bits = 3;
        fields[1].out_value = NULL;
-
        fields[1].in_value = NULL;
        fields[1].in_handler = NULL;

-
-
-
        fields[2].tap = jtag_info->tap;
        fields[2].num_bits = 32;
        fields[2].out_value = NULL;
-
        fields[2].in_value = NULL;
-
-
        fields[2].in_handler = NULL;

+       jtag_add_dr_scan_now(3, fields, TAP_INVALID);

-       jtag_add_dr_scan(3, fields, TAP_INVALID);
+       *in=flip_u32(le_to_h_u32(tmp), 32);

        jtag_add_runtest(0, TAP_INVALID);

@@ -335,6 +326,8 @@
        return ERROR_OK;
 }

+extern void arm_endianness(u8 *tmp, void *in, int size, int be);
+
 /* clock the target, and read the databus
  * the *in pointer points to a buffer where elements of 'size' bytes
  * are stored in big (be==1) or little (be==0) endianness
@@ -355,45 +348,26 @@
        fields[0].tap = jtag_info->tap;
        fields[0].num_bits = 32;
        fields[0].out_value = NULL;
-
-       fields[0].in_value = NULL;
-       switch (size)
-       {
-               case 4:
-                       fields[0].in_handler = (be) ? arm_jtag_buf_to_be32 :
arm_jtag_buf_to_le32; /* deprecated! invoke this from user code! */
-                       break;
-               case 2:
-                       fields[0].in_handler = (be) ? arm_jtag_buf_to_be16 :
arm_jtag_buf_to_le16; /* deprecated! invoke this from user code! */
-                       break;
-               case 1:
-                       fields[0].in_handler = arm_jtag_buf_to_8; /* 
deprecated! invoke
this from user code! */
-                       break;
-       }
-       fields[0].in_handler_priv = in;
-
-
+       u8 tmp[4];
+       fields[0].in_value = tmp;
+       fields[0].in_handler = NULL;

        fields[1].tap = jtag_info->tap;
        fields[1].num_bits = 3;
        fields[1].out_value = NULL;
-
        fields[1].in_value = NULL;
        fields[1].in_handler = NULL;

-
-
-
        fields[2].tap = jtag_info->tap;
        fields[2].num_bits = 32;
        fields[2].out_value = NULL;
-
        fields[2].in_value = NULL;
-
-
        fields[2].in_handler = NULL;

+       jtag_add_dr_scan_now(3, fields, TAP_INVALID);

-       jtag_add_dr_scan(3, fields, TAP_INVALID);
+       arm_endianness(tmp, in, size, be);
+

        jtag_add_runtest(0, TAP_INVALID);

Index: src/target/arm7tdmi.c
===================================================================
--- src/target/arm7tdmi.c       (revision 1631)
+++ src/target/arm7tdmi.c       (working copy)
@@ -234,6 +234,36 @@
        return ERROR_OK;
 }

+void arm_endianness(u8 *tmp, void *in, int size, int be)
+{
+       u32 readback=flip_u32(le_to_h_u32(tmp), 32);
+       switch (size)
+       {
+               case 4:
+                       if (be)
+                       {
+                               h_u32_to_be(((u8*)in), readback);
+                       } else
+                       {
+                                h_u32_to_le(((u8*)in), readback);
+                       }
+                       break;
+               case 2:
+                       if (be)
+                       {
+                               h_u16_to_be(((u8*)in), readback & 0xffff);
+                       } else
+                       {
+                               h_u16_to_le(((u8*)in), readback & 0xffff);
+                       }
+                       break;
+               case 1:
+                       *((u8 *)in)= readback & 0xff;
+                       break;
+       }
+
+}
+
 /* clock the target, and read the databus
  * the *in pointer points to a buffer where elements of 'size' bytes
  * are stored in big (be==1) or little (be==0) endianness
@@ -265,31 +295,7 @@

        jtag_add_dr_scan_now(2, fields, TAP_INVALID);

-       u32 readback=flip_u32(le_to_h_u32(tmp), 32);
-       switch (size)
-       {
-               case 4:
-                       if (be)
-                       {
-                               h_u32_to_be(((u8*)in), readback);
-                       } else
-                       {
-                                h_u32_to_le(((u8*)in), readback);
-                       }
-                       break;
-               case 2:
-                       if (be)
-                       {
-                               h_u16_to_be(((u8*)in), readback & 0xffff);
-                       } else
-                       {
-                               h_u16_to_le(((u8*)in), readback & 0xffff);
-                       }
-                       break;
-               case 1:
-                       *((u8 *)in)= readback & 0xff;
-                       break;
-       }
+       arm_endianness(tmp, in, size, be);

        jtag_add_runtest(0, TAP_INVALID);



-- 
Øyvind Harboe
Embedded software and hardware consulting services
http://consulting.zylin.com
_______________________________________________
Openocd-development mailing list
Openocd-development@lists.berlios.de
https://lists.berlios.de/mailman/listinfo/openocd-development

Reply via email to