hc
2023-11-22 983d7f83616922a6439b4352d1b3af488ee27f95
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
/*
 * Copyright (C) 2012 Regents of the University of California
 *
 *   This program is free software; you can redistribute it and/or
 *   modify it under the terms of the GNU General Public License
 *   as published by the Free Software Foundation, version 2.
 *
 *   This program is distributed in the hope that it will be useful,
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *   GNU General Public License for more details.
 */
 
#include <linux/init.h>
#include <linux/seq_file.h>
#include <linux/of.h>
 
/* Return -1 if not a valid hart */
int riscv_of_processor_hart(struct device_node *node)
{
   const char *isa, *status;
   u32 hart;
 
   if (!of_device_is_compatible(node, "riscv")) {
       pr_warn("Found incompatible CPU\n");
       return -(ENODEV);
   }
 
   if (of_property_read_u32(node, "reg", &hart)) {
       pr_warn("Found CPU without hart ID\n");
       return -(ENODEV);
   }
   if (hart >= NR_CPUS) {
       pr_info("Found hart ID %d, which is above NR_CPUs.  Disabling this hart\n", hart);
       return -(ENODEV);
   }
 
   if (of_property_read_string(node, "status", &status)) {
       pr_warn("CPU with hartid=%d has no \"status\" property\n", hart);
       return -(ENODEV);
   }
   if (strcmp(status, "okay")) {
       pr_info("CPU with hartid=%d has a non-okay status of \"%s\"\n", hart, status);
       return -(ENODEV);
   }
 
   if (of_property_read_string(node, "riscv,isa", &isa)) {
       pr_warn("CPU with hartid=%d has no \"riscv,isa\" property\n", hart);
       return -(ENODEV);
   }
   if (isa[0] != 'r' || isa[1] != 'v') {
       pr_warn("CPU with hartid=%d has an invalid ISA of \"%s\"\n", hart, isa);
       return -(ENODEV);
   }
 
   return hart;
}
 
#ifdef CONFIG_PROC_FS
 
static void *c_start(struct seq_file *m, loff_t *pos)
{
   *pos = cpumask_next(*pos - 1, cpu_online_mask);
   if ((*pos) < nr_cpu_ids)
       return (void *)(uintptr_t)(1 + *pos);
   return NULL;
}
 
static void *c_next(struct seq_file *m, void *v, loff_t *pos)
{
   (*pos)++;
   return c_start(m, pos);
}
 
static void c_stop(struct seq_file *m, void *v)
{
}
 
static int c_show(struct seq_file *m, void *v)
{
   unsigned long hart_id = (unsigned long)v - 1;
   struct device_node *node = of_get_cpu_node(hart_id, NULL);
   const char *compat, *isa, *mmu;
 
   seq_printf(m, "hart\t: %lu\n", hart_id);
   if (!of_property_read_string(node, "riscv,isa", &isa)
       && isa[0] == 'r'
       && isa[1] == 'v')
       seq_printf(m, "isa\t: %s\n", isa);
   if (!of_property_read_string(node, "mmu-type", &mmu)
       && !strncmp(mmu, "riscv,", 6))
       seq_printf(m, "mmu\t: %s\n", mmu+6);
   if (!of_property_read_string(node, "compatible", &compat)
       && strcmp(compat, "riscv"))
       seq_printf(m, "uarch\t: %s\n", compat);
   seq_puts(m, "\n");
 
   return 0;
}
 
const struct seq_operations cpuinfo_op = {
   .start    = c_start,
   .next    = c_next,
   .stop    = c_stop,
   .show    = c_show
};
 
#endif /* CONFIG_PROC_FS */