Differential D43672 Diff 133626 sys/riscv/riscv/mp_machdep.c

Changeset View

Standalone View

sys/riscv/riscv/mp_machdep.c

	Show First 20 Lines • Show All 73 Lines • ▼ Show 20 Lines

	static enum {			static enum {
	CPUS_UNKNOWN,			CPUS_UNKNOWN,
	#ifdef FDT			#ifdef FDT
	CPUS_FDT,			CPUS_FDT,
	#endif			#endif
	} cpu_enum_method;			} cpu_enum_method;

	static device_identify_t riscv64_cpu_identify;
	static device_probe_t riscv64_cpu_probe;
	static device_attach_t riscv64_cpu_attach;

	static void ipi_ast(void *);			static void ipi_ast(void *);
	static void ipi_hardclock(void *);			static void ipi_hardclock(void *);
	static void ipi_preempt(void *);			static void ipi_preempt(void *);
	static void ipi_rendezvous(void *);			static void ipi_rendezvous(void *);
	static void ipi_stop(void *);			static void ipi_stop(void *);

	extern uint32_t boot_hart;			extern uint32_t boot_hart;
	extern cpuset_t all_harts;			extern cpuset_t all_harts;

	#ifdef INVARIANTS			#ifdef INVARIANTS
	static uint32_t cpu_reg[MAXCPU][2];			static uint32_t cpu_reg[MAXCPU][2];
	#endif			#endif
	static device_t cpu_list[MAXCPU];

	void mpentry(u_long hartid);			void mpentry(u_long hartid);
	void init_secondary(uint64_t);			void init_secondary(uint64_t);

	static struct mtx ap_boot_mtx;			static struct mtx ap_boot_mtx;

	/* Stacks for AP initialization, discarded once idle threads are started. */			/* Stacks for AP initialization, discarded once idle threads are started. */
	void *bootstack;			void *bootstack;
	static void *bootstacks[MAXCPU];			static void *bootstacks[MAXCPU];

	/* Count of started APs, used to synchronize access to bootstack. */			/* Count of started APs, used to synchronize access to bootstack. */
	static volatile int aps_started;			static volatile int aps_started;

	/* Set to 1 once we're ready to let the APs out of the pen. */			/* Set to 1 once we're ready to let the APs out of the pen. */
	static volatile int aps_ready;			static volatile int aps_ready;

	/* Temporary variables for init_secondary() */			/* Temporary variables for init_secondary() */
	void *dpcpu[MAXCPU - 1];			void *dpcpu[MAXCPU - 1];

	static device_method_t riscv64_cpu_methods[] = {
	/* Device interface */
	DEVMETHOD(device_identify, riscv64_cpu_identify),
	DEVMETHOD(device_probe, riscv64_cpu_probe),
	DEVMETHOD(device_attach, riscv64_cpu_attach),

	DEVMETHOD_END
	};

	static driver_t riscv64_cpu_driver = {
	"riscv64_cpu",
	riscv64_cpu_methods,
	0
	};

	DRIVER_MODULE(riscv64_cpu, cpu, riscv64_cpu_driver, 0, 0);

	static void
	riscv64_cpu_identify(driver_t *driver, device_t parent)
	{

	if (device_find_child(parent, "riscv64_cpu", -1) != NULL)
	return;
	if (BUS_ADD_CHILD(parent, 0, "riscv64_cpu", -1) == NULL)
	device_printf(parent, "add child failed\n");
	}

	static int
	riscv64_cpu_probe(device_t dev)
	{
	u_int cpuid;

	cpuid = device_get_unit(dev);
	if (cpuid >= MAXCPU \|\| cpuid > mp_maxid)
	return (EINVAL);

	device_quiet(dev);
	return (0);
	}

	static int
	riscv64_cpu_attach(device_t dev)
	{
	const uint32_t *reg;
	size_t reg_size;
	u_int cpuid;
	int i;

	cpuid = device_get_unit(dev);

	if (cpuid >= MAXCPU \|\| cpuid > mp_maxid)
	return (EINVAL);
	KASSERT(cpu_list[cpuid] == NULL, ("Already have cpu %u", cpuid));

	reg = cpu_get_cpuid(dev, &reg_size);
	if (reg == NULL)
	return (EINVAL);

	if (bootverbose) {
	device_printf(dev, "register <");
	for (i = 0; i < reg_size; i++)
	printf("%s%x", (i == 0) ? "" : " ", reg[i]);
	printf(">\n");
	}

	/* Set the device to start it later */
	cpu_list[cpuid] = dev;

	return (0);
	}

	static void			static void
	release_aps(void *dummy __unused)			release_aps(void *dummy __unused)
	{			{
	cpuset_t mask;			cpuset_t mask;
	int i;			int i;

	if (mp_ncpus == 1)			if (mp_ncpus == 1)
	▲ Show 20 Lines • Show All 403 Lines • Show Last 20 Lines