cpu_acpi.c revision 1.4.2.2
1 1.4.2.2 pgoyette /* $NetBSD: cpu_acpi.c,v 1.4.2.2 2018/10/20 06:58:24 pgoyette Exp $ */ 2 1.4.2.2 pgoyette 3 1.4.2.2 pgoyette /*- 4 1.4.2.2 pgoyette * Copyright (c) 2018 The NetBSD Foundation, Inc. 5 1.4.2.2 pgoyette * All rights reserved. 6 1.4.2.2 pgoyette * 7 1.4.2.2 pgoyette * This code is derived from software contributed to The NetBSD Foundation 8 1.4.2.2 pgoyette * by Jared McNeill <jmcneill (at) invisible.ca>. 9 1.4.2.2 pgoyette * 10 1.4.2.2 pgoyette * Redistribution and use in source and binary forms, with or without 11 1.4.2.2 pgoyette * modification, are permitted provided that the following conditions 12 1.4.2.2 pgoyette * are met: 13 1.4.2.2 pgoyette * 1. Redistributions of source code must retain the above copyright 14 1.4.2.2 pgoyette * notice, this list of conditions and the following disclaimer. 15 1.4.2.2 pgoyette * 2. Redistributions in binary form must reproduce the above copyright 16 1.4.2.2 pgoyette * notice, this list of conditions and the following disclaimer in the 17 1.4.2.2 pgoyette * documentation and/or other materials provided with the distribution. 18 1.4.2.2 pgoyette * 19 1.4.2.2 pgoyette * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.4.2.2 pgoyette * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.4.2.2 pgoyette * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.4.2.2 pgoyette * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.4.2.2 pgoyette * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.4.2.2 pgoyette * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.4.2.2 pgoyette * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.4.2.2 pgoyette * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.4.2.2 pgoyette * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.4.2.2 pgoyette * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.4.2.2 pgoyette * POSSIBILITY OF SUCH DAMAGE. 30 1.4.2.2 pgoyette */ 31 1.4.2.2 pgoyette 32 1.4.2.2 pgoyette #include <sys/cdefs.h> 33 1.4.2.2 pgoyette __KERNEL_RCSID(0, "$NetBSD: cpu_acpi.c,v 1.4.2.2 2018/10/20 06:58:24 pgoyette Exp $"); 34 1.4.2.2 pgoyette 35 1.4.2.2 pgoyette #include <sys/param.h> 36 1.4.2.2 pgoyette #include <sys/bus.h> 37 1.4.2.2 pgoyette #include <sys/cpu.h> 38 1.4.2.2 pgoyette #include <sys/device.h> 39 1.4.2.2 pgoyette 40 1.4.2.2 pgoyette #include <dev/acpi/acpireg.h> 41 1.4.2.2 pgoyette #include <dev/acpi/acpivar.h> 42 1.4.2.2 pgoyette 43 1.4.2.2 pgoyette #include <arm/armreg.h> 44 1.4.2.2 pgoyette #include <arm/cpu.h> 45 1.4.2.2 pgoyette #include <arm/cpufunc.h> 46 1.4.2.2 pgoyette #include <arm/locore.h> 47 1.4.2.2 pgoyette 48 1.4.2.2 pgoyette #include <arm/arm/psci.h> 49 1.4.2.2 pgoyette 50 1.4.2.2 pgoyette extern struct cpu_info cpu_info_store[]; 51 1.4.2.2 pgoyette 52 1.4.2.2 pgoyette static int cpu_acpi_match(device_t, cfdata_t, void *); 53 1.4.2.2 pgoyette static void cpu_acpi_attach(device_t, device_t, void *); 54 1.4.2.2 pgoyette 55 1.4.2.2 pgoyette CFATTACH_DECL_NEW(cpu_acpi, 0, cpu_acpi_match, cpu_acpi_attach, NULL, NULL); 56 1.4.2.2 pgoyette 57 1.4.2.2 pgoyette static register_t 58 1.4.2.2 pgoyette cpu_acpi_mpstart_pa(void) 59 1.4.2.2 pgoyette { 60 1.4.2.2 pgoyette 61 1.4.2.2 pgoyette return (register_t)KERN_VTOPHYS((vaddr_t)cpu_mpstart); 62 1.4.2.2 pgoyette } 63 1.4.2.2 pgoyette 64 1.4.2.2 pgoyette static int 65 1.4.2.2 pgoyette cpu_acpi_match(device_t parent, cfdata_t cf, void *aux) 66 1.4.2.2 pgoyette { 67 1.4.2.2 pgoyette ACPI_SUBTABLE_HEADER *hdrp = aux; 68 1.4.2.2 pgoyette ACPI_MADT_GENERIC_INTERRUPT *gicc; 69 1.4.2.2 pgoyette 70 1.4.2.2 pgoyette if (hdrp->Type != ACPI_MADT_TYPE_GENERIC_INTERRUPT) 71 1.4.2.2 pgoyette return 0; 72 1.4.2.2 pgoyette 73 1.4.2.2 pgoyette gicc = (ACPI_MADT_GENERIC_INTERRUPT *)hdrp; 74 1.4.2.2 pgoyette 75 1.4.2.2 pgoyette return (gicc->Flags & ACPI_MADT_ENABLED) != 0; 76 1.4.2.2 pgoyette } 77 1.4.2.2 pgoyette 78 1.4.2.2 pgoyette static void 79 1.4.2.2 pgoyette cpu_acpi_attach(device_t parent, device_t self, void *aux) 80 1.4.2.2 pgoyette { 81 1.4.2.2 pgoyette ACPI_MADT_GENERIC_INTERRUPT *gicc = aux; 82 1.4.2.2 pgoyette const uint64_t mpidr = gicc->ArmMpidr; 83 1.4.2.2 pgoyette const int unit = device_unit(self); 84 1.4.2.2 pgoyette struct cpu_info *ci = &cpu_info_store[unit]; 85 1.4.2.2 pgoyette int error; 86 1.4.2.2 pgoyette 87 1.4.2.2 pgoyette if (cpu_mpidr_aff_read() != mpidr) { 88 1.4.2.2 pgoyette const u_int cpuindex = device_unit(self); 89 1.4.2.2 pgoyette 90 1.4.2.2 pgoyette cpu_mpidr[cpuindex] = mpidr; 91 1.4.2.2 pgoyette cpu_dcache_wb_range((vaddr_t)&cpu_mpidr[cpuindex], sizeof(cpu_mpidr[cpuindex])); 92 1.4.2.2 pgoyette 93 1.4.2.2 pgoyette /* XXX support spin table */ 94 1.4.2.2 pgoyette error = psci_cpu_on(mpidr, cpu_acpi_mpstart_pa(), 0); 95 1.4.2.2 pgoyette if (error != PSCI_SUCCESS) { 96 1.4.2.2 pgoyette aprint_error_dev(self, "failed to start CPU\n"); 97 1.4.2.2 pgoyette return; 98 1.4.2.2 pgoyette } 99 1.4.2.2 pgoyette 100 1.4.2.2 pgoyette __asm __volatile("sev" ::: "memory"); 101 1.4.2.2 pgoyette 102 1.4.2.2 pgoyette for (u_int i = 0x10000000; i > 0; i--) { 103 1.4.2.2 pgoyette membar_consumer(); 104 1.4.2.2 pgoyette if (arm_cpu_hatched & __BIT(cpuindex)) 105 1.4.2.2 pgoyette break; 106 1.4.2.2 pgoyette } 107 1.4.2.2 pgoyette } 108 1.4.2.2 pgoyette 109 1.4.2.2 pgoyette /* Store the ACPI Processor UID in cpu_info */ 110 1.4.2.2 pgoyette ci->ci_acpiid = gicc->Uid; 111 1.4.2.2 pgoyette 112 1.4.2.2 pgoyette /* Attach the CPU */ 113 1.4.2.2 pgoyette cpu_attach(self, mpidr); 114 1.4.2.2 pgoyette } 115
Indexes created Wed Oct 01 19:09:53 GMT 2025