machine_routines.c [plain text]
#include <ppc/machine_routines.h>
#include <ppc/machine_cpu.h>
#include <ppc/exception.h>
#include <ppc/misc_protos.h>
#include <ppc/Firmware.h>
#include <vm/vm_page.h>
#include <ppc/pmap.h>
#include <ppc/proc_reg.h>
#include <kern/processor.h>
boolean_t get_interrupts_enabled(void);
extern boolean_t set_interrupts_enabled(boolean_t);
vm_offset_t
ml_io_map(
vm_offset_t phys_addr,
vm_size_t size)
{
return(io_map(phys_addr,size));
}
vm_offset_t
ml_static_malloc(
vm_size_t size)
{
extern vm_offset_t static_memory_end;
extern boolean_t pmap_initialized;
vm_offset_t vaddr;
if (pmap_initialized)
return((vm_offset_t)NULL);
else {
vaddr = static_memory_end;
static_memory_end = round_page(vaddr+size);
return(vaddr);
}
}
vm_offset_t
ml_static_ptovirt(
vm_offset_t paddr)
{
extern vm_offset_t static_memory_end;
vm_offset_t vaddr;
vaddr = paddr;
if ( (vaddr < static_memory_end) && (pmap_extract(kernel_pmap, vaddr)==paddr) )
return(vaddr);
else
return((vm_offset_t)NULL);
}
void
ml_static_mfree(
vm_offset_t vaddr,
vm_size_t size)
{
vm_offset_t paddr_cur, vaddr_cur;
for (vaddr_cur = round_page(vaddr);
vaddr_cur < trunc_page(vaddr+size);
vaddr_cur += PAGE_SIZE) {
paddr_cur = pmap_extract(kernel_pmap, vaddr_cur);
if (paddr_cur != (vm_offset_t)NULL) {
vm_page_wire_count--;
pmap_remove(kernel_pmap, vaddr_cur, vaddr_cur+PAGE_SIZE);
vm_page_create(paddr_cur,paddr_cur+PAGE_SIZE);
}
}
}
vm_offset_t ml_vtophys(
vm_offset_t vaddr)
{
return(pmap_extract(kernel_pmap, vaddr));
}
void ml_install_interrupt_handler(
void *nub,
int source,
void *target,
IOInterruptHandler handler,
void *refCon)
{
int current_cpu;
boolean_t current_state;
current_cpu = cpu_number();
current_state = ml_get_interrupts_enabled();
per_proc_info[current_cpu].interrupt_nub = nub;
per_proc_info[current_cpu].interrupt_source = source;
per_proc_info[current_cpu].interrupt_target = target;
per_proc_info[current_cpu].interrupt_handler = handler;
per_proc_info[current_cpu].interrupt_refCon = refCon;
per_proc_info[current_cpu].get_interrupts_enabled
= get_interrupts_enabled;
per_proc_info[current_cpu].set_interrupts_enabled
= set_interrupts_enabled;
(void) ml_set_interrupts_enabled(current_state);
}
void ml_init_interrupt(void)
{
int current_cpu;
boolean_t current_state;
current_state = ml_get_interrupts_enabled();
current_cpu = cpu_number();
per_proc_info[current_cpu].get_interrupts_enabled
= get_interrupts_enabled;
per_proc_info[current_cpu].set_interrupts_enabled
= set_interrupts_enabled;
(void) ml_set_interrupts_enabled(current_state);
}
boolean_t fake_get_interrupts_enabled(void)
{
return((per_proc_info[cpu_number()].cpu_flags & turnEEon) != 0);
}
boolean_t fake_set_interrupts_enabled(boolean_t enable)
{
boolean_t interrupt_state_prev;
interrupt_state_prev =
(per_proc_info[cpu_number()].cpu_flags & turnEEon) != 0;
if (interrupt_state_prev != enable)
per_proc_info[cpu_number()].cpu_flags ^= turnEEon;
return(interrupt_state_prev);
}
boolean_t ml_get_interrupts_enabled(void)
{
return(per_proc_info[cpu_number()].get_interrupts_enabled());
}
boolean_t get_interrupts_enabled(void)
{
return((mfmsr() & MASK(MSR_EE)) != 0);
}
boolean_t ml_set_interrupts_enabled(boolean_t enable)
{
return(per_proc_info[cpu_number()].set_interrupts_enabled(enable));
}
boolean_t ml_at_interrupt_context(void)
{
return (per_proc_info[cpu_number()].istackptr == 0);
}
void ml_cause_interrupt(void)
{
CreateFakeIO();
}
void machine_clock_assist(void)
{
if (per_proc_info[cpu_number()].get_interrupts_enabled == fake_get_interrupts_enabled)
CreateFakeDEC();
}
void machine_idle(void)
{
if (per_proc_info[cpu_number()].get_interrupts_enabled != fake_get_interrupts_enabled) {
int cur_decr;
machine_idle_ppc();
cur_decr = isync_mfdec();
if (cur_decr < -10) {
mtdec(1);
}
}
}
void
machine_signal_idle(
processor_t processor)
{
(void)cpu_signal(processor->slot_num, SIGPwake, 0, 0);
}
kern_return_t
ml_processor_register(
ml_processor_info_t *processor_info,
processor_t *processor,
ipi_handler_t *ipi_handler)
{
kern_return_t ret;
int target_cpu;
if (processor_info->boot_cpu == FALSE) {
if (cpu_register(&target_cpu) != KERN_SUCCESS)
return KERN_FAILURE;
} else {
target_cpu= 0;
}
per_proc_info[target_cpu].cpu_id = processor_info->cpu_id;
per_proc_info[target_cpu].start_paddr = processor_info->start_paddr;
if(per_proc_info[target_cpu].pf.Available & pfCanNap)
if(processor_info->supports_nap)
per_proc_info[target_cpu].pf.Available |= pfWillNap;
if(processor_info->time_base_enable != (void(*)(cpu_id_t, boolean_t ))NULL)
per_proc_info[target_cpu].time_base_enable = processor_info->time_base_enable;
else
per_proc_info[target_cpu].time_base_enable = (void(*)(cpu_id_t, boolean_t ))NULL;
if(target_cpu == cpu_number())
__asm__ volatile("mtsprg 2,%0" : : "r" (per_proc_info[target_cpu].pf.Available));
*processor = cpu_to_processor(target_cpu);
*ipi_handler = cpu_signal_handler;
return KERN_SUCCESS;
}
boolean_t
ml_enable_nap(int target_cpu, boolean_t nap_enabled)
{
boolean_t prev_value = (per_proc_info[target_cpu].pf.Available & pfCanNap) && (per_proc_info[target_cpu].pf.Available & pfWillNap);
if(per_proc_info[target_cpu].pf.Available & pfCanNap) {
if (nap_enabled) per_proc_info[target_cpu].pf.Available |= pfWillNap;
else per_proc_info[target_cpu].pf.Available &= ~pfWillNap;
}
if(target_cpu == cpu_number())
__asm__ volatile("mtsprg 2,%0" : : "r" (per_proc_info[target_cpu].pf.Available));
return (prev_value);
}
void
ml_ppc_get_info(ml_ppc_cpu_info_t *cpu_info)
{
if (cpu_info == 0) return;
cpu_info->vector_unit = (per_proc_info[0].pf.Available & pfAltivec) != 0;
cpu_info->cache_line_size = per_proc_info[0].pf.lineSize;
cpu_info->l1_icache_size = per_proc_info[0].pf.l1iSize;
cpu_info->l1_dcache_size = per_proc_info[0].pf.l1dSize;
if (per_proc_info[0].pf.Available & pfL2) {
cpu_info->l2_settings = per_proc_info[0].pf.l2cr;
cpu_info->l2_cache_size = per_proc_info[0].pf.l2Size;
} else {
cpu_info->l2_settings = 0;
cpu_info->l2_cache_size = 0xFFFFFFFF;
}
if (per_proc_info[0].pf.Available & pfL3) {
cpu_info->l3_settings = per_proc_info[0].pf.l3cr;
cpu_info->l3_cache_size = per_proc_info[0].pf.l3Size;
} else {
cpu_info->l3_settings = 0;
cpu_info->l3_cache_size = 0xFFFFFFFF;
}
}
void
init_ast_check(processor_t processor)
{}
void
cause_ast_check(processor_t processor)
{
if ((processor != current_processor())
&& (per_proc_info[processor->slot_num].get_interrupts_enabled
!= fake_get_interrupts_enabled))
cpu_signal(processor->slot_num, SIGPast, NULL, NULL);
}
thread_t
switch_to_shutdown_context(
thread_t thread,
void (*doshutdown)(processor_t),
processor_t processor)
{
disable_preemption();
CreateShutdownCTX();
enable_preemption();
return((thread_t)(per_proc_info[cpu_number()].old_thread));
}
int
set_be_bit()
{
int mycpu;
boolean_t current_state;
current_state = ml_set_interrupts_enabled(FALSE);
mycpu = cpu_number();
per_proc_info[mycpu].cpu_flags |= traceBE;
(void) ml_set_interrupts_enabled(current_state);
return(1);
}
int
clr_be_bit()
{
int mycpu;
boolean_t current_state;
current_state = ml_set_interrupts_enabled(FALSE);
mycpu = cpu_number();
per_proc_info[mycpu].cpu_flags &= ~traceBE;
(void) ml_set_interrupts_enabled(current_state);
return(1);
}
int
be_tracing()
{
int mycpu = cpu_number();
return(per_proc_info[mycpu].cpu_flags & traceBE);
}