1 /* Blackfin JTAG model.
3 Copyright (C) 2010-2019 Free Software Foundation, Inc.
4 Contributed by Analog Devices, Inc.
6 This file is part of simulators.
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 3 of the License, or
11 (at your option) any later version.
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.
18 You should have received a copy of the GNU General Public License
19 along with this program. If not, see <http://www.gnu.org/licenses/>. */
25 #include "dv-bfin_jtag.h"
27 /* XXX: This is mostly a stub. There are more registers, but they're only
28 accessible via the JTAG scan chain and not the MMR interface. */
34 /* Order after here is important -- matches hardware MMR layout. */
39 #define mmr_base() offsetof(struct bfin_jtag, dspid)
40 #define mmr_offset(mmr) (offsetof(struct bfin_jtag, mmr) - mmr_base())
42 static const char * const mmr_names
[] =
44 "DSPID", NULL
, "DBGSTAT",
46 #define mmr_name(off) (mmr_names[(off) / 4] ? : "<INV>")
49 bfin_jtag_io_write_buffer (struct hw
*me
, const void *source
, int space
,
50 address_word addr
, unsigned nr_bytes
)
52 struct bfin_jtag
*jtag
= hw_data (me
);
57 /* Invalid access mode is higher priority than missing register. */
58 if (!dv_bfin_mmr_require_32 (me
, addr
, nr_bytes
, true))
61 value
= dv_load_4 (source
);
62 mmr_off
= addr
- jtag
->base
;
63 valuep
= (void *)((unsigned long)jtag
+ mmr_base() + mmr_off
);
69 case mmr_offset(dbgstat
):
70 dv_w1c_4 (valuep
, value
, 0xc);
72 case mmr_offset(dspid
):
73 /* Discard writes to these. */
76 dv_bfin_mmr_invalid (me
, addr
, nr_bytes
, true);
84 bfin_jtag_io_read_buffer (struct hw
*me
, void *dest
, int space
,
85 address_word addr
, unsigned nr_bytes
)
87 struct bfin_jtag
*jtag
= hw_data (me
);
92 /* Invalid access mode is higher priority than missing register. */
93 if (!dv_bfin_mmr_require_32 (me
, addr
, nr_bytes
, false))
96 mmr_off
= addr
- jtag
->base
;
97 valuep
= (void *)((unsigned long)jtag
+ mmr_base() + mmr_off
);
103 case mmr_offset(dbgstat
):
104 case mmr_offset(dspid
):
108 dv_bfin_mmr_invalid (me
, addr
, nr_bytes
, false);
112 dv_store_4 (dest
, value
);
118 attach_bfin_jtag_regs (struct hw
*me
, struct bfin_jtag
*jtag
)
120 address_word attach_address
;
122 unsigned attach_size
;
123 reg_property_spec reg
;
125 if (hw_find_property (me
, "reg") == NULL
)
126 hw_abort (me
, "Missing \"reg\" property");
128 if (!hw_find_reg_array_property (me
, "reg", 0, ®
))
129 hw_abort (me
, "\"reg\" property must contain three addr/size entries");
131 hw_unit_address_to_attach_address (hw_parent (me
),
133 &attach_space
, &attach_address
, me
);
134 hw_unit_size_to_attach_size (hw_parent (me
), ®
.size
, &attach_size
, me
);
136 if (attach_size
!= BFIN_COREMMR_JTAG_SIZE
)
137 hw_abort (me
, "\"reg\" size must be %#x", BFIN_COREMMR_JTAG_SIZE
);
139 hw_attach_address (hw_parent (me
),
140 0, attach_space
, attach_address
, attach_size
, me
);
142 jtag
->base
= attach_address
;
146 bfin_jtag_finish (struct hw
*me
)
148 struct bfin_jtag
*jtag
;
150 jtag
= HW_ZALLOC (me
, struct bfin_jtag
);
152 set_hw_data (me
, jtag
);
153 set_hw_io_read_buffer (me
, bfin_jtag_io_read_buffer
);
154 set_hw_io_write_buffer (me
, bfin_jtag_io_write_buffer
);
156 attach_bfin_jtag_regs (me
, jtag
);
158 /* Initialize the JTAG state. */
159 jtag
->dspid
= bfin_model_get_dspid (hw_system (me
));
162 const struct hw_descriptor dv_bfin_jtag_descriptor
[] =
164 {"bfin_jtag", bfin_jtag_finish
,},