Home | History | Annotate | Line # | Download | only in arm 
      1 /*	$NetBSD: arm_cpu_topology.c,v 1.9 2024/12/10 11:27:29 jmcneill Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2020 Matthew R. Green
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 /* CPU topology support for ARMv7 and ARMv8 systems.  */
     30 
     31 #include "opt_multiprocessor.h"
     32 
     33 #include <sys/cdefs.h>
     34 __KERNEL_RCSID(0, "$NetBSD: arm_cpu_topology.c,v 1.9 2024/12/10 11:27:29 jmcneill Exp $");
     35 
     36 #include <sys/param.h>
     37 #include <sys/systm.h>
     38 #include <sys/kernel.h>
     39 #include <sys/device.h>
     40 
     41 #include <arm/cpu.h>
     42 #include <arm/cpu_topology.h>
     43 #include <arm/armreg.h>
     44 
     45 #include <prop/proplib.h>
     46 
     47 void
     48 arm_cpu_topology_set(struct cpu_info * const ci, mpidr_t mpidr)
     49 {
     50 #ifdef MULTIPROCESSOR
     51 	uint pkgid, coreid, smtid, numaid;
     52 	bool use_aff0 = (mpidr & MPIDR_MT) != 0 ||
     53 			CPU_ID_ORYON_P(ci->ci_midr);
     54 
     55 	/* NUMA info comes from firmware tables (ACPI or FDT). */
     56 	numaid = ci->ci_numa_id;
     57 
     58 	if (use_aff0) {
     59 		pkgid = __SHIFTOUT(mpidr, MPIDR_AFF2);
     60 		coreid = __SHIFTOUT(mpidr, MPIDR_AFF1);
     61 		smtid = __SHIFTOUT(mpidr, MPIDR_AFF0);
     62 	} else {
     63 		pkgid = __SHIFTOUT(mpidr, MPIDR_AFF1);
     64 		coreid = __SHIFTOUT(mpidr, MPIDR_AFF0);
     65 		smtid = 0;
     66 	}
     67 	cpu_topology_set(ci, pkgid, coreid, smtid, numaid);
     68 #endif /* MULTIPROCESSOR */
     69 }
     70 
     71 void
     72 arm_cpu_do_topology(struct cpu_info *const newci)
     73 {
     74 #ifdef MULTIPROCESSOR
     75 	struct cpu_info *ci;
     76 	CPU_INFO_ITERATOR cii;
     77 	prop_dictionary_t dict;
     78 	uint32_t capacity_dmips_mhz = 0;
     79 	static uint32_t best_cap = 0;
     80 
     81 	dict = device_properties(newci->ci_dev);
     82 	if (prop_dictionary_get_uint32(dict, "capacity_dmips_mhz",
     83 	    &capacity_dmips_mhz))
     84 		newci->ci_capacity_dmips_mhz = capacity_dmips_mhz;
     85 
     86 	if (newci->ci_capacity_dmips_mhz > best_cap)
     87 		best_cap = newci->ci_capacity_dmips_mhz;
     88 
     89 	/*
     90 	 * CPU_INFO_FOREACH() doesn't always work for this CPU until
     91 	 * mi_cpu_attach() is called and ncpu is bumped, so call it
     92 	 * directly here.  This also handles the not-MP case.
     93 	 */
     94 	cpu_topology_setspeed(newci, newci->ci_capacity_dmips_mhz < best_cap);
     95 
     96 	/*
     97 	 * Using saved largest capacity, refresh previous topology info.
     98 	 * It's supposed to be OK to re-set topology.
     99 	 */
    100 	for (CPU_INFO_FOREACH(cii, ci)) {
    101 		if (ci == newci)
    102 			continue;
    103 		cpu_topology_setspeed(ci,
    104 		    ci->ci_capacity_dmips_mhz < best_cap);
    105 	}
    106 #endif /* MULTIPROCESSOR */
    107 }
    108