Merge branch 'topic/ice1724-pm' into for-linus
[pandora-kernel.git] / arch / parisc / kernel / processor.c
1 /*
2  *    Initial setup-routines for HP 9000 based hardware.
3  *
4  *    Copyright (C) 1991, 1992, 1995  Linus Torvalds
5  *    Modifications for PA-RISC (C) 1999-2008 Helge Deller <deller@gmx.de>
6  *    Modifications copyright 1999 SuSE GmbH (Philipp Rumpf)
7  *    Modifications copyright 2000 Martin K. Petersen <mkp@mkp.net>
8  *    Modifications copyright 2000 Philipp Rumpf <prumpf@tux.org>
9  *    Modifications copyright 2001 Ryan Bradetich <rbradetich@uswest.net>
10  *
11  *    Initial PA-RISC Version: 04-23-1999 by Helge Deller
12  *
13  *    This program is free software; you can redistribute it and/or modify
14  *    it under the terms of the GNU General Public License as published by
15  *    the Free Software Foundation; either version 2, or (at your option)
16  *    any later version.
17  *
18  *    This program is distributed in the hope that it will be useful,
19  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
20  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  *    GNU General Public License for more details.
22  *
23  *    You should have received a copy of the GNU General Public License
24  *    along with this program; if not, write to the Free Software
25  *    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26  *
27  */
28 #include <linux/delay.h>
29 #include <linux/init.h>
30 #include <linux/mm.h>
31 #include <linux/module.h>
32 #include <linux/seq_file.h>
33 #include <linux/slab.h>
34 #include <linux/cpu.h>
35 #include <asm/param.h>
36 #include <asm/cache.h>
37 #include <asm/hardware.h>       /* for register_parisc_driver() stuff */
38 #include <asm/processor.h>
39 #include <asm/page.h>
40 #include <asm/pdc.h>
41 #include <asm/pdcpat.h>
42 #include <asm/irq.h>            /* for struct irq_region */
43 #include <asm/parisc-device.h>
44
45 struct system_cpuinfo_parisc boot_cpu_data __read_mostly;
46 EXPORT_SYMBOL(boot_cpu_data);
47
48 DEFINE_PER_CPU(struct cpuinfo_parisc, cpu_data);
49
50 extern int update_cr16_clocksource(void);       /* from time.c */
51
52 /*
53 **      PARISC CPU driver - claim "device" and initialize CPU data structures.
54 **
55 ** Consolidate per CPU initialization into (mostly) one module.
56 ** Monarch CPU will initialize boot_cpu_data which shouldn't
57 ** change once the system has booted.
58 **
59 ** The callback *should* do per-instance initialization of
60 ** everything including the monarch. "Per CPU" init code in
61 ** setup.c:start_parisc() has migrated here and start_parisc()
62 ** will call register_parisc_driver(&cpu_driver) before calling do_inventory().
63 **
64 ** The goal of consolidating CPU initialization into one place is
65 ** to make sure all CPUs get initialized the same way.
66 ** The code path not shared is how PDC hands control of the CPU to the OS.
67 ** The initialization of OS data structures is the same (done below).
68 */
69
70 /**
71  * init_cpu_profiler - enable/setup per cpu profiling hooks.
72  * @cpunum: The processor instance.
73  *
74  * FIXME: doesn't do much yet...
75  */
76 static void __cpuinit
77 init_percpu_prof(unsigned long cpunum)
78 {
79         struct cpuinfo_parisc *p;
80
81         p = &per_cpu(cpu_data, cpunum);
82         p->prof_counter = 1;
83         p->prof_multiplier = 1;
84 }
85
86
87 /**
88  * processor_probe - Determine if processor driver should claim this device.
89  * @dev: The device which has been found.
90  *
91  * Determine if processor driver should claim this chip (return 0) or not 
92  * (return 1).  If so, initialize the chip and tell other partners in crime 
93  * they have work to do.
94  */
95 static int __cpuinit processor_probe(struct parisc_device *dev)
96 {
97         unsigned long txn_addr;
98         unsigned long cpuid;
99         struct cpuinfo_parisc *p;
100
101 #ifdef CONFIG_SMP
102         if (num_online_cpus() >= nr_cpu_ids) {
103                 printk(KERN_INFO "num_online_cpus() >= nr_cpu_ids\n");
104                 return 1;
105         }
106 #else
107         if (boot_cpu_data.cpu_count > 0) {
108                 printk(KERN_INFO "CONFIG_SMP=n  ignoring additional CPUs\n");
109                 return 1;
110         }
111 #endif
112
113         /* logical CPU ID and update global counter
114          * May get overwritten by PAT code.
115          */
116         cpuid = boot_cpu_data.cpu_count;
117         txn_addr = dev->hpa.start;      /* for legacy PDC */
118
119 #ifdef CONFIG_64BIT
120         if (is_pdc_pat()) {
121                 ulong status;
122                 unsigned long bytecnt;
123                 pdc_pat_cell_mod_maddr_block_t *pa_pdc_cell;
124 #undef USE_PAT_CPUID
125 #ifdef USE_PAT_CPUID
126                 struct pdc_pat_cpu_num cpu_info;
127 #endif
128
129                 pa_pdc_cell = kmalloc(sizeof (*pa_pdc_cell), GFP_KERNEL);
130                 if (!pa_pdc_cell)
131                         panic("couldn't allocate memory for PDC_PAT_CELL!");
132
133                 status = pdc_pat_cell_module(&bytecnt, dev->pcell_loc,
134                         dev->mod_index, PA_VIEW, pa_pdc_cell);
135
136                 BUG_ON(PDC_OK != status);
137
138                 /* verify it's the same as what do_pat_inventory() found */
139                 BUG_ON(dev->mod_info != pa_pdc_cell->mod_info);
140                 BUG_ON(dev->pmod_loc != pa_pdc_cell->mod_location);
141
142                 txn_addr = pa_pdc_cell->mod[0];   /* id_eid for IO sapic */
143
144                 kfree(pa_pdc_cell);
145
146 #ifdef USE_PAT_CPUID
147 /* We need contiguous numbers for cpuid. Firmware's notion
148  * of cpuid is for physical CPUs and we just don't care yet.
149  * We'll care when we need to query PAT PDC about a CPU *after*
150  * boot time (ie shutdown a CPU from an OS perspective).
151  */
152                 /* get the cpu number */
153                 status = pdc_pat_cpu_get_number(&cpu_info, dev->hpa.start);
154
155                 BUG_ON(PDC_OK != status);
156
157                 if (cpu_info.cpu_num >= NR_CPUS) {
158                         printk(KERN_WARNING "IGNORING CPU at 0x%x,"
159                                 " cpu_slot_id > NR_CPUS"
160                                 " (%ld > %d)\n",
161                                 dev->hpa.start, cpu_info.cpu_num, NR_CPUS);
162                         /* Ignore CPU since it will only crash */
163                         boot_cpu_data.cpu_count--;
164                         return 1;
165                 } else {
166                         cpuid = cpu_info.cpu_num;
167                 }
168 #endif
169         }
170 #endif
171
172         p = &per_cpu(cpu_data, cpuid);
173         boot_cpu_data.cpu_count++;
174
175         /* initialize counters - CPU 0 gets it_value set in time_init() */
176         if (cpuid)
177                 memset(p, 0, sizeof(struct cpuinfo_parisc));
178
179         p->loops_per_jiffy = loops_per_jiffy;
180         p->dev = dev;           /* Save IODC data in case we need it */
181         p->hpa = dev->hpa.start;        /* save CPU hpa */
182         p->cpuid = cpuid;       /* save CPU id */
183         p->txn_addr = txn_addr; /* save CPU IRQ address */
184 #ifdef CONFIG_SMP
185         /*
186         ** FIXME: review if any other initialization is clobbered
187         **        for boot_cpu by the above memset().
188         */
189         init_percpu_prof(cpuid);
190 #endif
191
192         /*
193         ** CONFIG_SMP: init_smp_config() will attempt to get CPUs into
194         ** OS control. RENDEZVOUS is the default state - see mem_set above.
195         **      p->state = STATE_RENDEZVOUS;
196         */
197
198 #if 0
199         /* CPU 0 IRQ table is statically allocated/initialized */
200         if (cpuid) {
201                 struct irqaction actions[];
202
203                 /*
204                 ** itimer and ipi IRQ handlers are statically initialized in
205                 ** arch/parisc/kernel/irq.c. ie Don't need to register them.
206                 */
207                 actions = kmalloc(sizeof(struct irqaction)*MAX_CPU_IRQ, GFP_ATOMIC);
208                 if (!actions) {
209                         /* not getting it's own table, share with monarch */
210                         actions = cpu_irq_actions[0];
211                 }
212
213                 cpu_irq_actions[cpuid] = actions;
214         }
215 #endif
216
217         /* 
218          * Bring this CPU up now! (ignore bootstrap cpuid == 0)
219          */
220 #ifdef CONFIG_SMP
221         if (cpuid) {
222                 set_cpu_present(cpuid, true);
223                 cpu_up(cpuid);
224         }
225 #endif
226
227         /* If we've registered more than one cpu,
228          * we'll use the jiffies clocksource since cr16
229          * is not synchronized between CPUs.
230          */
231         update_cr16_clocksource();
232
233         return 0;
234 }
235
236 /**
237  * collect_boot_cpu_data - Fill the boot_cpu_data structure.
238  *
239  * This function collects and stores the generic processor information
240  * in the boot_cpu_data structure.
241  */
242 void __init collect_boot_cpu_data(void)
243 {
244         memset(&boot_cpu_data, 0, sizeof(boot_cpu_data));
245
246         boot_cpu_data.cpu_hz = 100 * PAGE0->mem_10msec; /* Hz of this PARISC */
247
248         /* get CPU-Model Information... */
249 #define p ((unsigned long *)&boot_cpu_data.pdc.model)
250         if (pdc_model_info(&boot_cpu_data.pdc.model) == PDC_OK)
251                 printk(KERN_INFO 
252                         "model %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
253                         p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7], p[8]);
254 #undef p
255
256         if (pdc_model_versions(&boot_cpu_data.pdc.versions, 0) == PDC_OK)
257                 printk(KERN_INFO "vers  %08lx\n", 
258                         boot_cpu_data.pdc.versions);
259
260         if (pdc_model_cpuid(&boot_cpu_data.pdc.cpuid) == PDC_OK)
261                 printk(KERN_INFO "CPUID vers %ld rev %ld (0x%08lx)\n",
262                         (boot_cpu_data.pdc.cpuid >> 5) & 127,
263                         boot_cpu_data.pdc.cpuid & 31,
264                         boot_cpu_data.pdc.cpuid);
265
266         if (pdc_model_capabilities(&boot_cpu_data.pdc.capabilities) == PDC_OK)
267                 printk(KERN_INFO "capabilities 0x%lx\n",
268                         boot_cpu_data.pdc.capabilities);
269
270         if (pdc_model_sysmodel(boot_cpu_data.pdc.sys_model_name) == PDC_OK)
271                 printk(KERN_INFO "model %s\n",
272                         boot_cpu_data.pdc.sys_model_name);
273
274         boot_cpu_data.hversion =  boot_cpu_data.pdc.model.hversion;
275         boot_cpu_data.sversion =  boot_cpu_data.pdc.model.sversion;
276
277         boot_cpu_data.cpu_type = parisc_get_cpu_type(boot_cpu_data.hversion);
278         boot_cpu_data.cpu_name = cpu_name_version[boot_cpu_data.cpu_type][0];
279         boot_cpu_data.family_name = cpu_name_version[boot_cpu_data.cpu_type][1];
280 }
281
282
283
284 /**
285  * init_per_cpu - Handle individual processor initializations.
286  * @cpunum: logical processor number.
287  *
288  * This function handles initialization for *every* CPU
289  * in the system:
290  *
291  * o Set "default" CPU width for trap handlers
292  *
293  * o Enable FP coprocessor
294  *   REVISIT: this could be done in the "code 22" trap handler.
295  *      (frowands idea - that way we know which processes need FP
296  *      registers saved on the interrupt stack.)
297  *   NEWS FLASH: wide kernels need FP coprocessor enabled to handle
298  *      formatted printing of %lx for example (double divides I think)
299  *
300  * o Enable CPU profiling hooks.
301  */
302 int __cpuinit init_per_cpu(int cpunum)
303 {
304         int ret;
305         struct pdc_coproc_cfg coproc_cfg;
306
307         set_firmware_width();
308         ret = pdc_coproc_cfg(&coproc_cfg);
309
310         if(ret >= 0 && coproc_cfg.ccr_functional) {
311                 mtctl(coproc_cfg.ccr_functional, 10);  /* 10 == Coprocessor Control Reg */
312
313                 /* FWIW, FP rev/model is a more accurate way to determine
314                 ** CPU type. CPU rev/model has some ambiguous cases.
315                 */
316                 per_cpu(cpu_data, cpunum).fp_rev = coproc_cfg.revision;
317                 per_cpu(cpu_data, cpunum).fp_model = coproc_cfg.model;
318
319                 printk(KERN_INFO  "FP[%d] enabled: Rev %ld Model %ld\n",
320                         cpunum, coproc_cfg.revision, coproc_cfg.model);
321
322                 /*
323                 ** store status register to stack (hopefully aligned)
324                 ** and clear the T-bit.
325                 */
326                 asm volatile ("fstd    %fr0,8(%sp)");
327
328         } else {
329                 printk(KERN_WARNING  "WARNING: No FP CoProcessor?!"
330                         " (coproc_cfg.ccr_functional == 0x%lx, expected 0xc0)\n"
331 #ifdef CONFIG_64BIT
332                         "Halting Machine - FP required\n"
333 #endif
334                         , coproc_cfg.ccr_functional);
335 #ifdef CONFIG_64BIT
336                 mdelay(100);    /* previous chars get pushed to console */
337                 panic("FP CoProc not reported");
338 #endif
339         }
340
341         /* FUTURE: Enable Performance Monitor : ccr bit 0x20 */
342         init_percpu_prof(cpunum);
343
344         return ret;
345 }
346
347 /*
348  * Display CPU info for all CPUs.
349  */
350 int
351 show_cpuinfo (struct seq_file *m, void *v)
352 {
353         unsigned long cpu;
354
355         for_each_online_cpu(cpu) {
356                 const struct cpuinfo_parisc *cpuinfo = &per_cpu(cpu_data, cpu);
357 #ifdef CONFIG_SMP
358                 if (0 == cpuinfo->hpa)
359                         continue;
360 #endif
361                 seq_printf(m, "processor\t: %lu\n"
362                                 "cpu family\t: PA-RISC %s\n",
363                                  cpu, boot_cpu_data.family_name);
364
365                 seq_printf(m, "cpu\t\t: %s\n",  boot_cpu_data.cpu_name );
366
367                 /* cpu MHz */
368                 seq_printf(m, "cpu MHz\t\t: %d.%06d\n",
369                                  boot_cpu_data.cpu_hz / 1000000,
370                                  boot_cpu_data.cpu_hz % 1000000  );
371
372                 seq_printf(m, "capabilities\t:");
373                 if (boot_cpu_data.pdc.capabilities & PDC_MODEL_OS32)
374                         seq_printf(m, " os32");
375                 if (boot_cpu_data.pdc.capabilities & PDC_MODEL_OS64)
376                         seq_printf(m, " os64");
377                 seq_printf(m, "\n");
378
379                 seq_printf(m, "model\t\t: %s\n"
380                                 "model name\t: %s\n",
381                                  boot_cpu_data.pdc.sys_model_name,
382                                  cpuinfo->dev ?
383                                  cpuinfo->dev->name : "Unknown");
384
385                 seq_printf(m, "hversion\t: 0x%08x\n"
386                                 "sversion\t: 0x%08x\n",
387                                  boot_cpu_data.hversion,
388                                  boot_cpu_data.sversion );
389
390                 /* print cachesize info */
391                 show_cache_info(m);
392
393                 seq_printf(m, "bogomips\t: %lu.%02lu\n",
394                              cpuinfo->loops_per_jiffy / (500000 / HZ),
395                              (cpuinfo->loops_per_jiffy / (5000 / HZ)) % 100);
396
397                 seq_printf(m, "software id\t: %ld\n\n",
398                                 boot_cpu_data.pdc.model.sw_id);
399         }
400         return 0;
401 }
402
403 static const struct parisc_device_id processor_tbl[] = {
404         { HPHW_NPROC, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, SVERSION_ANY_ID },
405         { 0, }
406 };
407
408 static struct parisc_driver cpu_driver = {
409         .name           = "CPU",
410         .id_table       = processor_tbl,
411         .probe          = processor_probe
412 };
413
414 /**
415  * processor_init - Processor initialization procedure.
416  *
417  * Register this driver.
418  */
419 void __init processor_init(void)
420 {
421         register_parisc_driver(&cpu_driver);
422 }