2 * Copyright (c) 2012-2014 Bastian Koppelmann C-Lab/University Paderborn
4 * This library is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU Lesser General Public
6 * License as published by the Free Software Foundation; either
7 * version 2.1 of the License, or (at your option) any later version.
9 * This library is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * Lesser General Public License for more details.
14 * You should have received a copy of the GNU Lesser General Public
15 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18 #include "qemu/osdep.h"
20 #include "hw/registerfields.h"
22 #include "exec/exec-all.h"
23 #include "fpu/softfloat-helpers.h"
24 #include "qemu/qemu-print.h"
34 static int get_physical_address(CPUTriCoreState
*env
, hwaddr
*physical
,
35 int *prot
, target_ulong address
,
36 MMUAccessType access_type
, int mmu_idx
)
38 int ret
= TLBRET_MATCH
;
40 *physical
= address
& 0xFFFFFFFF;
41 *prot
= PAGE_READ
| PAGE_WRITE
| PAGE_EXEC
;
46 hwaddr
tricore_cpu_get_phys_page_debug(CPUState
*cs
, vaddr addr
)
48 TriCoreCPU
*cpu
= TRICORE_CPU(cs
);
51 int mmu_idx
= cpu_mmu_index(&cpu
->env
, false);
53 if (get_physical_address(&cpu
->env
, &phys_addr
, &prot
, addr
,
54 MMU_DATA_LOAD
, mmu_idx
)) {
60 /* TODO: Add exception support */
61 static void raise_mmu_exception(CPUTriCoreState
*env
, target_ulong address
,
62 int rw
, int tlb_error
)
66 bool tricore_cpu_tlb_fill(CPUState
*cs
, vaddr address
, int size
,
67 MMUAccessType rw
, int mmu_idx
,
68 bool probe
, uintptr_t retaddr
)
70 TriCoreCPU
*cpu
= TRICORE_CPU(cs
);
71 CPUTriCoreState
*env
= &cpu
->env
;
77 ret
= get_physical_address(env
, &physical
, &prot
,
78 address
, rw
, mmu_idx
);
80 qemu_log_mask(CPU_LOG_MMU
, "%s address=" TARGET_FMT_lx
" ret %d physical "
81 HWADDR_FMT_plx
" prot %d\n",
82 __func__
, (target_ulong
)address
, ret
, physical
, prot
);
84 if (ret
== TLBRET_MATCH
) {
85 tlb_set_page(cs
, address
& TARGET_PAGE_MASK
,
86 physical
& TARGET_PAGE_MASK
, prot
| PAGE_EXEC
,
87 mmu_idx
, TARGET_PAGE_SIZE
);
94 raise_mmu_exception(env
, address
, rw
, ret
);
95 cpu_loop_exit_restore(cs
, retaddr
);
99 static void tricore_cpu_list_entry(gpointer data
, gpointer user_data
)
101 ObjectClass
*oc
= data
;
102 const char *typename
;
105 typename
= object_class_get_name(oc
);
106 name
= g_strndup(typename
, strlen(typename
) - strlen("-" TYPE_TRICORE_CPU
));
107 qemu_printf(" %s\n", name
);
111 void tricore_cpu_list(void)
115 list
= object_class_get_list_sorted(TYPE_TRICORE_CPU
, false);
116 qemu_printf("Available CPUs:\n");
117 g_slist_foreach(list
, tricore_cpu_list_entry
, NULL
);
121 void fpu_set_state(CPUTriCoreState
*env
)
123 switch (extract32(env
->PSW
, 24, 2)) {
125 set_float_rounding_mode(float_round_nearest_even
, &env
->fp_status
);
128 set_float_rounding_mode(float_round_up
, &env
->fp_status
);
131 set_float_rounding_mode(float_round_down
, &env
->fp_status
);
134 set_float_rounding_mode(float_round_to_zero
, &env
->fp_status
);
138 set_flush_inputs_to_zero(1, &env
->fp_status
);
139 set_flush_to_zero(1, &env
->fp_status
);
140 set_float_detect_tininess(float_tininess_before_rounding
, &env
->fp_status
);
141 set_default_nan_mode(1, &env
->fp_status
);
144 uint32_t psw_read(CPUTriCoreState
*env
)
146 /* clear all USB bits */
147 env
->PSW
&= 0x7ffffff;
148 /* now set them from the cache */
149 env
->PSW
|= ((env
->PSW_USB_C
!= 0) << 31);
150 env
->PSW
|= ((env
->PSW_USB_V
& (1 << 31)) >> 1);
151 env
->PSW
|= ((env
->PSW_USB_SV
& (1 << 31)) >> 2);
152 env
->PSW
|= ((env
->PSW_USB_AV
& (1 << 31)) >> 3);
153 env
->PSW
|= ((env
->PSW_USB_SAV
& (1 << 31)) >> 4);
158 void psw_write(CPUTriCoreState
*env
, uint32_t val
)
160 env
->PSW_USB_C
= (val
& MASK_USB_C
);
161 env
->PSW_USB_V
= (val
& MASK_USB_V
) << 1;
162 env
->PSW_USB_SV
= (val
& MASK_USB_SV
) << 2;
163 env
->PSW_USB_AV
= (val
& MASK_USB_AV
) << 3;
164 env
->PSW_USB_SAV
= (val
& MASK_USB_SAV
) << 4;
170 #define FIELD_GETTER_WITH_FEATURE(NAME, REG, FIELD, FEATURE) \
171 uint32_t NAME(CPUTriCoreState *env) \
173 if (tricore_has_feature(env, TRICORE_FEATURE_##FEATURE)) { \
174 return FIELD_EX32(env->REG, REG, FIELD ## _ ## FEATURE); \
176 return FIELD_EX32(env->REG, REG, FIELD ## _13); \
179 #define FIELD_GETTER(NAME, REG, FIELD) \
180 uint32_t NAME(CPUTriCoreState *env) \
182 return FIELD_EX32(env->REG, REG, FIELD); \
185 #define FIELD_SETTER_WITH_FEATURE(NAME, REG, FIELD, FEATURE) \
186 void NAME(CPUTriCoreState *env, uint32_t val) \
188 if (tricore_has_feature(env, TRICORE_FEATURE_##FEATURE)) { \
189 env->REG = FIELD_DP32(env->REG, REG, FIELD ## _ ## FEATURE, val); \
191 env->REG = FIELD_DP32(env->REG, REG, FIELD ## _13, val); \
194 #define FIELD_SETTER(NAME, REG, FIELD) \
195 void NAME(CPUTriCoreState *env, uint32_t val) \
197 env->REG = FIELD_DP32(env->REG, REG, FIELD, val); \
200 FIELD_GETTER_WITH_FEATURE(pcxi_get_pcpn
, PCXI
, PCPN
, 161)
201 FIELD_SETTER_WITH_FEATURE(pcxi_set_pcpn
, PCXI
, PCPN
, 161)
202 FIELD_GETTER_WITH_FEATURE(pcxi_get_pie
, PCXI
, PIE
, 161)
203 FIELD_SETTER_WITH_FEATURE(pcxi_set_pie
, PCXI
, PIE
, 161)
204 FIELD_GETTER_WITH_FEATURE(pcxi_get_ul
, PCXI
, UL
, 161)
205 FIELD_SETTER_WITH_FEATURE(pcxi_set_ul
, PCXI
, UL
, 161)
206 FIELD_GETTER(pcxi_get_pcxs
, PCXI
, PCXS
)
207 FIELD_GETTER(pcxi_get_pcxo
, PCXI
, PCXO
)
209 FIELD_GETTER_WITH_FEATURE(icr_get_ie
, ICR
, IE
, 161)
210 FIELD_SETTER_WITH_FEATURE(icr_set_ie
, ICR
, IE
, 161)
211 FIELD_GETTER(icr_get_ccpn
, ICR
, CCPN
)
212 FIELD_SETTER(icr_set_ccpn
, ICR
, CCPN
)