int boot_vcpu(struct domain *d, int vcpuid, vcpu_guest_context_u ctxt)
{
struct vcpu *v = d->vcpu[vcpuid];
BUG_ON(v->is_initialised);
return arch_set_info_guest(v, ctxt);
}
int do_psci_cpu_on(uint32_t vcpuid, register_t entry_point)
{
struct vcpu *v;
struct domain *d = current->domain;
struct vcpu_guest_context *ctxt;
int rc;
int is_thumb = entry_point & 1;
if ( (vcpuid < 0) || (vcpuid >= MAX_VIRT_CPUS) )
return PSCI_EINVAL;
if ( vcpuid >= d->max_vcpus || (v = d->vcpu[vcpuid]) == NULL )
return PSCI_EINVAL;
/* THUMB set is not allowed with 64-bit domain */
if ( is_pv64_domain(d) && is_thumb )
return PSCI_EINVAL;
if ( (ctxt = alloc_vcpu_guest_context()) == NULL )
return PSCI_DENIED;
vgic_clear_pending_irqs(v);
memset(ctxt, 0, sizeof(*ctxt));
ctxt->user_regs.pc64 = (u64) entry_point;
ctxt->sctlr = SCTLR_GUEST_INIT;
ctxt->ttbr0 = 0;
ctxt->ttbr1 = 0;
ctxt->ttbcr = 0; /* Defined Reset Value */
if ( is_pv32_domain(d) )
ctxt->user_regs.cpsr = PSR_GUEST32_INIT;
#ifdef CONFIG_ARM_64
else
ctxt->user_regs.cpsr = PSR_GUEST64_INIT;
#endif
/* Start the VCPU with THUMB set if it's requested by the kernel */
if ( is_thumb )
ctxt->user_regs.cpsr |= PSR_THUMB;
ctxt->flags = VGCF_online;
domain_lock(d);
rc = arch_set_info_guest(v, ctxt);
free_vcpu_guest_context(ctxt);
if ( rc < 0 )
{
domain_unlock(d);
return PSCI_DENIED;
}
domain_unlock(d);
vcpu_wake(v);
return PSCI_SUCCESS;
}
static void
fw_hypercall_ipi (struct pt_regs *regs)
{
int cpu = regs->r14;
int vector = regs->r15;
struct vcpu *targ;
struct domain *d = current->domain;
/* Be sure the target exists. */
if (cpu >= d->max_vcpus)
return;
targ = d->vcpu[cpu];
if (targ == NULL)
return;
if (vector == XEN_SAL_BOOT_RENDEZ_VEC
&& (!targ->is_initialised
|| test_bit(_VPF_down, &targ->pause_flags))) {
/* First start: initialize vpcu. */
if (!targ->is_initialised) {
if (arch_set_info_guest (targ, NULL) != 0) {
printk ("arch_boot_vcpu: failure\n");
return;
}
}
/* First or next rendez-vous: set registers. */
vcpu_init_regs (targ);
vcpu_regs (targ)->cr_iip = d->arch.sal_data->boot_rdv_ip;
vcpu_regs (targ)->r1 = d->arch.sal_data->boot_rdv_r1;
vcpu_regs (targ)->b0 = FW_HYPERCALL_SAL_RETURN_PADDR;
if (test_and_clear_bit(_VPF_down,
&targ->pause_flags)) {
vcpu_wake(targ);
printk(XENLOG_INFO "arch_boot_vcpu: vcpu %d awaken\n",
targ->vcpu_id);
}
else
printk ("arch_boot_vcpu: huu, already awaken!\n");
}
else {
int running = targ->is_running;
vcpu_pend_interrupt(targ, vector);
vcpu_unblock(targ);
if (running)
smp_send_event_check_cpu(targ->processor);
}
return;
}
int do_psci_cpu_on(uint32_t vcpuid, register_t entry_point)
{
struct vcpu *v;
struct domain *d = current->domain;
struct vcpu_guest_context *ctxt;
int rc;
if ( (vcpuid < 0) || (vcpuid >= MAX_VIRT_CPUS) )
return PSCI_EINVAL;
if ( vcpuid >= d->max_vcpus || (v = d->vcpu[vcpuid]) == NULL )
return PSCI_EINVAL;
if ( (ctxt = alloc_vcpu_guest_context()) == NULL )
return PSCI_DENIED;
vgic_clear_pending_irqs(v);
memset(ctxt, 0, sizeof(*ctxt));
ctxt->user_regs.pc64 = (u64) entry_point;
ctxt->sctlr = SCTLR_BASE;
ctxt->ttbr0 = 0;
ctxt->ttbr1 = 0;
ctxt->ttbcr = 0; /* Defined Reset Value */
ctxt->user_regs.cpsr = PSR_GUEST_INIT;
ctxt->flags = VGCF_online;
domain_lock(d);
rc = arch_set_info_guest(v, ctxt);
free_vcpu_guest_context(ctxt);
if ( rc < 0 )
{
domain_unlock(d);
return PSCI_DENIED;
}
domain_unlock(d);
vcpu_wake(v);
return PSCI_SUCCESS;
}
static int do_common_cpu_on(register_t target_cpu, register_t entry_point,
register_t context_id,int ver)
{
struct vcpu *v;
struct domain *d = current->domain;
struct vcpu_guest_context *ctxt;
int rc;
int is_thumb = entry_point & 1;
register_t vcpuid;
vcpuid = vaffinity_to_vcpuid(target_cpu);
if ( vcpuid >= d->max_vcpus || (v = d->vcpu[vcpuid]) == NULL )
return PSCI_INVALID_PARAMETERS;
/* THUMB set is not allowed with 64-bit domain */
if ( is_64bit_domain(d) && is_thumb )
return PSCI_INVALID_PARAMETERS;
if( ( ver == XEN_PSCI_V_0_2 ) &&
( !test_bit(_VPF_down, &v->pause_flags) ) )
return PSCI_ALREADY_ON;
if ( (ctxt = alloc_vcpu_guest_context()) == NULL )
return PSCI_DENIED;
vgic_clear_pending_irqs(v);
memset(ctxt, 0, sizeof(*ctxt));
ctxt->user_regs.pc64 = (u64) entry_point;
ctxt->sctlr = SCTLR_GUEST_INIT;
ctxt->ttbr0 = 0;
ctxt->ttbr1 = 0;
ctxt->ttbcr = 0; /* Defined Reset Value */
if ( is_32bit_domain(d) )
{
ctxt->user_regs.cpsr = PSR_GUEST32_INIT;
if( ver == XEN_PSCI_V_0_2 )
ctxt->user_regs.r0_usr = context_id;
}
#ifdef CONFIG_ARM_64
else
{
ctxt->user_regs.cpsr = PSR_GUEST64_INIT;
if( ver == XEN_PSCI_V_0_2 )
ctxt->user_regs.x0 = context_id;
}
#endif
/* Start the VCPU with THUMB set if it's requested by the kernel */
if ( is_thumb )
ctxt->user_regs.cpsr |= PSR_THUMB;
ctxt->flags = VGCF_online;
domain_lock(d);
rc = arch_set_info_guest(v, ctxt);
free_vcpu_guest_context(ctxt);
if ( rc < 0 )
{
domain_unlock(d);
return PSCI_DENIED;
}
domain_unlock(d);
vcpu_wake(v);
return PSCI_SUCCESS;
}
