embedded hosts: optimize common code path for core arm operations
[fw/openocd] / src / target / arm_jtag.h
1 /***************************************************************************
2  *   Copyright (C) 2005 by Dominic Rath                                    *
3  *   Dominic.Rath@gmx.de                                                   *
4  *                                                                         *
5  *   Copyright (C) 2007,2008 Ã˜yvind Harboe                                 *
6  *   oyvind.harboe@zylin.com                                               *
7  *                                                                         *
8  *   This program is free software; you can redistribute it and/or modify  *
9  *   it under the terms of the GNU General Public License as published by  *
10  *   the Free Software Foundation; either version 2 of the License, or     *
11  *   (at your option) any later version.                                   *
12  *                                                                         *
13  *   This program is distributed in the hope that it will be useful,       *
14  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
15  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
16  *   GNU General Public License for more details.                          *
17  *                                                                         *
18  *   You should have received a copy of the GNU General Public License     *
19  *   along with this program; if not, write to the                         *
20  *   Free Software Foundation, Inc.,                                       *
21  *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
22  ***************************************************************************/
23 #ifndef ARM_JTAG
24 #define ARM_JTAG
25
26 #include <jtag/jtag.h>
27
28 struct arm_jtag
29 {
30         struct jtag_tap *tap;
31
32         uint32_t scann_size;
33         uint32_t scann_instr;
34         uint32_t cur_scan_chain;
35
36         uint32_t intest_instr;
37 };
38
39 int arm_jtag_set_instr_inner(struct arm_jtag *jtag_info, uint32_t new_instr,  void *no_verify_capture);
40 static inline int arm_jtag_set_instr(struct arm_jtag *jtag_info,
41                 uint32_t new_instr, void *no_verify_capture)
42 {
43         /* inline most common code path */
44         struct jtag_tap *tap;
45         tap = jtag_info->tap;
46         if (tap == NULL)
47                 return ERROR_FAIL;
48
49         if (buf_get_u32(tap->cur_instr, 0, tap->ir_length) != new_instr)
50         {
51                 return arm_jtag_set_instr_inner(jtag_info, new_instr, no_verify_capture);
52         }
53
54         return ERROR_OK;
55
56 }
57
58
59 int arm_jtag_scann_inner(struct arm_jtag *jtag_info, uint32_t new_scan_chain);
60 static inline int arm_jtag_scann(struct arm_jtag *jtag_info, uint32_t new_scan_chain)
61 {
62         /* inline most common code path */
63         int retval = ERROR_OK;
64         if (jtag_info->cur_scan_chain != new_scan_chain)
65         {
66                 return arm_jtag_scann_inner(jtag_info, new_scan_chain);
67         }
68
69         return retval;
70 }
71
72
73 int arm_jtag_setup_connection(struct arm_jtag *jtag_info);
74
75 /* use this as a static so we can inline it in -O3 and refer to it via a pointer  */
76 static __inline__ void arm7flip32(jtag_callback_data_t arg)
77 {
78   uint8_t *in = (uint8_t *)arg;
79   *((uint32_t *)in) = flip_u32(le_to_h_u32(in), 32);
80 }
81
82 static __inline__ void arm_le_to_h_u32(jtag_callback_data_t arg)
83 {
84   uint8_t *in = (uint8_t *)arg;
85   *((uint32_t *)in) = le_to_h_u32(in);
86 }
87
88
89 #endif /* ARM_JTAG */
90