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 void fpu_set_state(CPUTriCoreState
*env
)
101 switch (extract32(env
->PSW
, 24, 2)) {
103 set_float_rounding_mode(float_round_nearest_even
, &env
->fp_status
);
106 set_float_rounding_mode(float_round_up
, &env
->fp_status
);
109 set_float_rounding_mode(float_round_down
, &env
->fp_status
);
112 set_float_rounding_mode(float_round_to_zero
, &env
->fp_status
);
116 set_flush_inputs_to_zero(1, &env
->fp_status
);
117 set_flush_to_zero(1, &env
->fp_status
);
118 set_float_detect_tininess(float_tininess_before_rounding
, &env
->fp_status
);
119 set_default_nan_mode(1, &env
->fp_status
);
122 uint32_t psw_read(CPUTriCoreState
*env
)
124 /* clear all USB bits */
125 env
->PSW
&= 0x7ffffff;
126 /* now set them from the cache */
127 env
->PSW
|= ((env
->PSW_USB_C
!= 0) << 31);
128 env
->PSW
|= ((env
->PSW_USB_V
& (1 << 31)) >> 1);
129 env
->PSW
|= ((env
->PSW_USB_SV
& (1 << 31)) >> 2);
130 env
->PSW
|= ((env
->PSW_USB_AV
& (1 << 31)) >> 3);
131 env
->PSW
|= ((env
->PSW_USB_SAV
& (1 << 31)) >> 4);
136 void psw_write(CPUTriCoreState
*env
, uint32_t val
)
138 env
->PSW_USB_C
= (val
& MASK_USB_C
);
139 env
->PSW_USB_V
= (val
& MASK_USB_V
) << 1;
140 env
->PSW_USB_SV
= (val
& MASK_USB_SV
) << 2;
141 env
->PSW_USB_AV
= (val
& MASK_USB_AV
) << 3;
142 env
->PSW_USB_SAV
= (val
& MASK_USB_SAV
) << 4;
148 #define FIELD_GETTER_WITH_FEATURE(NAME, REG, FIELD, FEATURE) \
149 uint32_t NAME(CPUTriCoreState *env) \
151 if (tricore_has_feature(env, TRICORE_FEATURE_##FEATURE)) { \
152 return FIELD_EX32(env->REG, REG, FIELD ## _ ## FEATURE); \
154 return FIELD_EX32(env->REG, REG, FIELD ## _13); \
157 #define FIELD_GETTER(NAME, REG, FIELD) \
158 uint32_t NAME(CPUTriCoreState *env) \
160 return FIELD_EX32(env->REG, REG, FIELD); \
163 #define FIELD_SETTER_WITH_FEATURE(NAME, REG, FIELD, FEATURE) \
164 void NAME(CPUTriCoreState *env, uint32_t val) \
166 if (tricore_has_feature(env, TRICORE_FEATURE_##FEATURE)) { \
167 env->REG = FIELD_DP32(env->REG, REG, FIELD ## _ ## FEATURE, val); \
169 env->REG = FIELD_DP32(env->REG, REG, FIELD ## _13, val); \
172 #define FIELD_SETTER(NAME, REG, FIELD) \
173 void NAME(CPUTriCoreState *env, uint32_t val) \
175 env->REG = FIELD_DP32(env->REG, REG, FIELD, val); \
178 FIELD_GETTER_WITH_FEATURE(pcxi_get_pcpn
, PCXI
, PCPN
, 161)
179 FIELD_SETTER_WITH_FEATURE(pcxi_set_pcpn
, PCXI
, PCPN
, 161)
180 FIELD_GETTER_WITH_FEATURE(pcxi_get_pie
, PCXI
, PIE
, 161)
181 FIELD_SETTER_WITH_FEATURE(pcxi_set_pie
, PCXI
, PIE
, 161)
182 FIELD_GETTER_WITH_FEATURE(pcxi_get_ul
, PCXI
, UL
, 161)
183 FIELD_SETTER_WITH_FEATURE(pcxi_set_ul
, PCXI
, UL
, 161)
184 FIELD_GETTER(pcxi_get_pcxs
, PCXI
, PCXS
)
185 FIELD_GETTER(pcxi_get_pcxo
, PCXI
, PCXO
)
187 FIELD_GETTER_WITH_FEATURE(icr_get_ie
, ICR
, IE
, 161)
188 FIELD_SETTER_WITH_FEATURE(icr_set_ie
, ICR
, IE
, 161)
189 FIELD_GETTER(icr_get_ccpn
, ICR
, CCPN
)
190 FIELD_SETTER(icr_set_ccpn
, ICR
, CCPN
)