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