Merge branch 'x86-fixes-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6] / arch / x86 / kernel / tlb_uv.c
1 /*
2  *      SGI UltraViolet TLB flush routines.
3  *
4  *      (c) 2008 Cliff Wickman <cpw@sgi.com>, SGI.
5  *
6  *      This code is released under the GNU General Public License version 2 or
7  *      later.
8  */
9 #include <linux/seq_file.h>
10 #include <linux/proc_fs.h>
11 #include <linux/kernel.h>
12
13 #include <asm/mmu_context.h>
14 #include <asm/uv/uv_mmrs.h>
15 #include <asm/uv/uv_hub.h>
16 #include <asm/uv/uv_bau.h>
17 #include <asm/genapic.h>
18 #include <asm/idle.h>
19 #include <asm/tsc.h>
20 #include <asm/irq_vectors.h>
21
22 #include <mach_apic.h>
23
24 static struct bau_control       **uv_bau_table_bases __read_mostly;
25 static int                      uv_bau_retry_limit __read_mostly;
26
27 /* position of pnode (which is nasid>>1): */
28 static int                      uv_nshift __read_mostly;
29
30 static unsigned long            uv_mmask __read_mostly;
31
32 static DEFINE_PER_CPU(struct ptc_stats, ptcstats);
33 static DEFINE_PER_CPU(struct bau_control, bau_control);
34
35 /*
36  * Free a software acknowledge hardware resource by clearing its Pending
37  * bit. This will return a reply to the sender.
38  * If the message has timed out, a reply has already been sent by the
39  * hardware but the resource has not been released. In that case our
40  * clear of the Timeout bit (as well) will free the resource. No reply will
41  * be sent (the hardware will only do one reply per message).
42  */
43 static void uv_reply_to_message(int resource,
44                                 struct bau_payload_queue_entry *msg,
45                                 struct bau_msg_status *msp)
46 {
47         unsigned long dw;
48
49         dw = (1 << (resource + UV_SW_ACK_NPENDING)) | (1 << resource);
50         msg->replied_to = 1;
51         msg->sw_ack_vector = 0;
52         if (msp)
53                 msp->seen_by.bits = 0;
54         uv_write_local_mmr(UVH_LB_BAU_INTD_SOFTWARE_ACKNOWLEDGE_ALIAS, dw);
55 }
56
57 /*
58  * Do all the things a cpu should do for a TLB shootdown message.
59  * Other cpu's may come here at the same time for this message.
60  */
61 static void uv_bau_process_message(struct bau_payload_queue_entry *msg,
62                                    int msg_slot, int sw_ack_slot)
63 {
64         unsigned long this_cpu_mask;
65         struct bau_msg_status *msp;
66         int cpu;
67
68         msp = __get_cpu_var(bau_control).msg_statuses + msg_slot;
69         cpu = uv_blade_processor_id();
70         msg->number_of_cpus =
71             uv_blade_nr_online_cpus(uv_node_to_blade_id(numa_node_id()));
72         this_cpu_mask = 1UL << cpu;
73         if (msp->seen_by.bits & this_cpu_mask)
74                 return;
75         atomic_or_long(&msp->seen_by.bits, this_cpu_mask);
76
77         if (msg->replied_to == 1)
78                 return;
79
80         if (msg->address == TLB_FLUSH_ALL) {
81                 local_flush_tlb();
82                 __get_cpu_var(ptcstats).alltlb++;
83         } else {
84                 __flush_tlb_one(msg->address);
85                 __get_cpu_var(ptcstats).onetlb++;
86         }
87
88         __get_cpu_var(ptcstats).requestee++;
89
90         atomic_inc_short(&msg->acknowledge_count);
91         if (msg->number_of_cpus == msg->acknowledge_count)
92                 uv_reply_to_message(sw_ack_slot, msg, msp);
93 }
94
95 /*
96  * Examine the payload queue on one distribution node to see
97  * which messages have not been seen, and which cpu(s) have not seen them.
98  *
99  * Returns the number of cpu's that have not responded.
100  */
101 static int uv_examine_destination(struct bau_control *bau_tablesp, int sender)
102 {
103         struct bau_payload_queue_entry *msg;
104         struct bau_msg_status *msp;
105         int count = 0;
106         int i;
107         int j;
108
109         for (msg = bau_tablesp->va_queue_first, i = 0; i < DEST_Q_SIZE;
110              msg++, i++) {
111                 if ((msg->sending_cpu == sender) && (!msg->replied_to)) {
112                         msp = bau_tablesp->msg_statuses + i;
113                         printk(KERN_DEBUG
114                                "blade %d: address:%#lx %d of %d, not cpu(s): ",
115                                i, msg->address, msg->acknowledge_count,
116                                msg->number_of_cpus);
117                         for (j = 0; j < msg->number_of_cpus; j++) {
118                                 if (!((1L << j) & msp->seen_by.bits)) {
119                                         count++;
120                                         printk("%d ", j);
121                                 }
122                         }
123                         printk("\n");
124                 }
125         }
126         return count;
127 }
128
129 /*
130  * Examine the payload queue on all the distribution nodes to see
131  * which messages have not been seen, and which cpu(s) have not seen them.
132  *
133  * Returns the number of cpu's that have not responded.
134  */
135 static int uv_examine_destinations(struct bau_target_nodemask *distribution)
136 {
137         int sender;
138         int i;
139         int count = 0;
140
141         sender = smp_processor_id();
142         for (i = 0; i < sizeof(struct bau_target_nodemask) * BITSPERBYTE; i++) {
143                 if (!bau_node_isset(i, distribution))
144                         continue;
145                 count += uv_examine_destination(uv_bau_table_bases[i], sender);
146         }
147         return count;
148 }
149
150 /*
151  * wait for completion of a broadcast message
152  *
153  * return COMPLETE, RETRY or GIVEUP
154  */
155 static int uv_wait_completion(struct bau_desc *bau_desc,
156                               unsigned long mmr_offset, int right_shift)
157 {
158         int exams = 0;
159         long destination_timeouts = 0;
160         long source_timeouts = 0;
161         unsigned long descriptor_status;
162
163         while ((descriptor_status = (((unsigned long)
164                 uv_read_local_mmr(mmr_offset) >>
165                         right_shift) & UV_ACT_STATUS_MASK)) !=
166                         DESC_STATUS_IDLE) {
167                 if (descriptor_status == DESC_STATUS_SOURCE_TIMEOUT) {
168                         source_timeouts++;
169                         if (source_timeouts > SOURCE_TIMEOUT_LIMIT)
170                                 source_timeouts = 0;
171                         __get_cpu_var(ptcstats).s_retry++;
172                         return FLUSH_RETRY;
173                 }
174                 /*
175                  * spin here looking for progress at the destinations
176                  */
177                 if (descriptor_status == DESC_STATUS_DESTINATION_TIMEOUT) {
178                         destination_timeouts++;
179                         if (destination_timeouts > DESTINATION_TIMEOUT_LIMIT) {
180                                 /*
181                                  * returns number of cpus not responding
182                                  */
183                                 if (uv_examine_destinations
184                                     (&bau_desc->distribution) == 0) {
185                                         __get_cpu_var(ptcstats).d_retry++;
186                                         return FLUSH_RETRY;
187                                 }
188                                 exams++;
189                                 if (exams >= uv_bau_retry_limit) {
190                                         printk(KERN_DEBUG
191                                                "uv_flush_tlb_others");
192                                         printk("giving up on cpu %d\n",
193                                                smp_processor_id());
194                                         return FLUSH_GIVEUP;
195                                 }
196                                 /*
197                                  * delays can hang the simulator
198                                    udelay(1000);
199                                  */
200                                 destination_timeouts = 0;
201                         }
202                 }
203         }
204         return FLUSH_COMPLETE;
205 }
206
207 /**
208  * uv_flush_send_and_wait
209  *
210  * Send a broadcast and wait for a broadcast message to complete.
211  *
212  * The cpumaskp mask contains the cpus the broadcast was sent to.
213  *
214  * Returns 1 if all remote flushing was done. The mask is zeroed.
215  * Returns 0 if some remote flushing remains to be done. The mask is left
216  * unchanged.
217  */
218 int uv_flush_send_and_wait(int cpu, int this_blade, struct bau_desc *bau_desc,
219                            cpumask_t *cpumaskp)
220 {
221         int completion_status = 0;
222         int right_shift;
223         int tries = 0;
224         int blade;
225         int bit;
226         unsigned long mmr_offset;
227         unsigned long index;
228         cycles_t time1;
229         cycles_t time2;
230
231         if (cpu < UV_CPUS_PER_ACT_STATUS) {
232                 mmr_offset = UVH_LB_BAU_SB_ACTIVATION_STATUS_0;
233                 right_shift = cpu * UV_ACT_STATUS_SIZE;
234         } else {
235                 mmr_offset = UVH_LB_BAU_SB_ACTIVATION_STATUS_1;
236                 right_shift =
237                     ((cpu - UV_CPUS_PER_ACT_STATUS) * UV_ACT_STATUS_SIZE);
238         }
239         time1 = get_cycles();
240         do {
241                 tries++;
242                 index = (1UL << UVH_LB_BAU_SB_ACTIVATION_CONTROL_PUSH_SHFT) |
243                         cpu;
244                 uv_write_local_mmr(UVH_LB_BAU_SB_ACTIVATION_CONTROL, index);
245                 completion_status = uv_wait_completion(bau_desc, mmr_offset,
246                                         right_shift);
247         } while (completion_status == FLUSH_RETRY);
248         time2 = get_cycles();
249         __get_cpu_var(ptcstats).sflush += (time2 - time1);
250         if (tries > 1)
251                 __get_cpu_var(ptcstats).retriesok++;
252
253         if (completion_status == FLUSH_GIVEUP) {
254                 /*
255                  * Cause the caller to do an IPI-style TLB shootdown on
256                  * the cpu's, all of which are still in the mask.
257                  */
258                 __get_cpu_var(ptcstats).ptc_i++;
259                 return 0;
260         }
261
262         /*
263          * Success, so clear the remote cpu's from the mask so we don't
264          * use the IPI method of shootdown on them.
265          */
266         for_each_cpu_mask(bit, *cpumaskp) {
267                 blade = uv_cpu_to_blade_id(bit);
268                 if (blade == this_blade)
269                         continue;
270                 cpu_clear(bit, *cpumaskp);
271         }
272         if (!cpus_empty(*cpumaskp))
273                 return 0;
274         return 1;
275 }
276
277 /**
278  * uv_flush_tlb_others - globally purge translation cache of a virtual
279  * address or all TLB's
280  * @cpumaskp: mask of all cpu's in which the address is to be removed
281  * @mm: mm_struct containing virtual address range
282  * @va: virtual address to be removed (or TLB_FLUSH_ALL for all TLB's on cpu)
283  *
284  * This is the entry point for initiating any UV global TLB shootdown.
285  *
286  * Purges the translation caches of all specified processors of the given
287  * virtual address, or purges all TLB's on specified processors.
288  *
289  * The caller has derived the cpumaskp from the mm_struct and has subtracted
290  * the local cpu from the mask.  This function is called only if there
291  * are bits set in the mask. (e.g. flush_tlb_page())
292  *
293  * The cpumaskp is converted into a nodemask of the nodes containing
294  * the cpus.
295  *
296  * Returns 1 if all remote flushing was done.
297  * Returns 0 if some remote flushing remains to be done.
298  */
299 int uv_flush_tlb_others(cpumask_t *cpumaskp, struct mm_struct *mm,
300                         unsigned long va)
301 {
302         int i;
303         int bit;
304         int blade;
305         int cpu;
306         int this_blade;
307         int locals = 0;
308         struct bau_desc *bau_desc;
309
310         cpu = uv_blade_processor_id();
311         this_blade = uv_numa_blade_id();
312         bau_desc = __get_cpu_var(bau_control).descriptor_base;
313         bau_desc += UV_ITEMS_PER_DESCRIPTOR * cpu;
314
315         bau_nodes_clear(&bau_desc->distribution, UV_DISTRIBUTION_SIZE);
316
317         i = 0;
318         for_each_cpu_mask(bit, *cpumaskp) {
319                 blade = uv_cpu_to_blade_id(bit);
320                 BUG_ON(blade > (UV_DISTRIBUTION_SIZE - 1));
321                 if (blade == this_blade) {
322                         locals++;
323                         continue;
324                 }
325                 bau_node_set(blade, &bau_desc->distribution);
326                 i++;
327         }
328         if (i == 0) {
329                 /*
330                  * no off_node flushing; return status for local node
331                  */
332                 if (locals)
333                         return 0;
334                 else
335                         return 1;
336         }
337         __get_cpu_var(ptcstats).requestor++;
338         __get_cpu_var(ptcstats).ntargeted += i;
339
340         bau_desc->payload.address = va;
341         bau_desc->payload.sending_cpu = smp_processor_id();
342
343         return uv_flush_send_and_wait(cpu, this_blade, bau_desc, cpumaskp);
344 }
345
346 /*
347  * The BAU message interrupt comes here. (registered by set_intr_gate)
348  * See entry_64.S
349  *
350  * We received a broadcast assist message.
351  *
352  * Interrupts may have been disabled; this interrupt could represent
353  * the receipt of several messages.
354  *
355  * All cores/threads on this node get this interrupt.
356  * The last one to see it does the s/w ack.
357  * (the resource will not be freed until noninterruptable cpus see this
358  *  interrupt; hardware will timeout the s/w ack and reply ERROR)
359  */
360 void uv_bau_message_interrupt(struct pt_regs *regs)
361 {
362         struct bau_payload_queue_entry *va_queue_first;
363         struct bau_payload_queue_entry *va_queue_last;
364         struct bau_payload_queue_entry *msg;
365         struct pt_regs *old_regs = set_irq_regs(regs);
366         cycles_t time1;
367         cycles_t time2;
368         int msg_slot;
369         int sw_ack_slot;
370         int fw;
371         int count = 0;
372         unsigned long local_pnode;
373
374         ack_APIC_irq();
375         exit_idle();
376         irq_enter();
377
378         time1 = get_cycles();
379
380         local_pnode = uv_blade_to_pnode(uv_numa_blade_id());
381
382         va_queue_first = __get_cpu_var(bau_control).va_queue_first;
383         va_queue_last = __get_cpu_var(bau_control).va_queue_last;
384
385         msg = __get_cpu_var(bau_control).bau_msg_head;
386         while (msg->sw_ack_vector) {
387                 count++;
388                 fw = msg->sw_ack_vector;
389                 msg_slot = msg - va_queue_first;
390                 sw_ack_slot = ffs(fw) - 1;
391
392                 uv_bau_process_message(msg, msg_slot, sw_ack_slot);
393
394                 msg++;
395                 if (msg > va_queue_last)
396                         msg = va_queue_first;
397                 __get_cpu_var(bau_control).bau_msg_head = msg;
398         }
399         if (!count)
400                 __get_cpu_var(ptcstats).nomsg++;
401         else if (count > 1)
402                 __get_cpu_var(ptcstats).multmsg++;
403
404         time2 = get_cycles();
405         __get_cpu_var(ptcstats).dflush += (time2 - time1);
406
407         irq_exit();
408         set_irq_regs(old_regs);
409 }
410
411 static void uv_enable_timeouts(void)
412 {
413         int i;
414         int blade;
415         int last_blade;
416         int pnode;
417         int cur_cpu = 0;
418         unsigned long apicid;
419
420         last_blade = -1;
421         for_each_online_node(i) {
422                 blade = uv_node_to_blade_id(i);
423                 if (blade == last_blade)
424                         continue;
425                 last_blade = blade;
426                 apicid = per_cpu(x86_cpu_to_apicid, cur_cpu);
427                 pnode = uv_blade_to_pnode(blade);
428                 cur_cpu += uv_blade_nr_possible_cpus(i);
429         }
430 }
431
432 static void *uv_ptc_seq_start(struct seq_file *file, loff_t *offset)
433 {
434         if (*offset < num_possible_cpus())
435                 return offset;
436         return NULL;
437 }
438
439 static void *uv_ptc_seq_next(struct seq_file *file, void *data, loff_t *offset)
440 {
441         (*offset)++;
442         if (*offset < num_possible_cpus())
443                 return offset;
444         return NULL;
445 }
446
447 static void uv_ptc_seq_stop(struct seq_file *file, void *data)
448 {
449 }
450
451 /*
452  * Display the statistics thru /proc
453  * data points to the cpu number
454  */
455 static int uv_ptc_seq_show(struct seq_file *file, void *data)
456 {
457         struct ptc_stats *stat;
458         int cpu;
459
460         cpu = *(loff_t *)data;
461
462         if (!cpu) {
463                 seq_printf(file,
464                 "# cpu requestor requestee one all sretry dretry ptc_i ");
465                 seq_printf(file,
466                 "sw_ack sflush dflush sok dnomsg dmult starget\n");
467         }
468         if (cpu < num_possible_cpus() && cpu_online(cpu)) {
469                 stat = &per_cpu(ptcstats, cpu);
470                 seq_printf(file, "cpu %d %ld %ld %ld %ld %ld %ld %ld ",
471                            cpu, stat->requestor,
472                            stat->requestee, stat->onetlb, stat->alltlb,
473                            stat->s_retry, stat->d_retry, stat->ptc_i);
474                 seq_printf(file, "%lx %ld %ld %ld %ld %ld %ld\n",
475                            uv_read_global_mmr64(uv_blade_to_pnode
476                                         (uv_cpu_to_blade_id(cpu)),
477                                         UVH_LB_BAU_INTD_SOFTWARE_ACKNOWLEDGE),
478                            stat->sflush, stat->dflush,
479                            stat->retriesok, stat->nomsg,
480                            stat->multmsg, stat->ntargeted);
481         }
482
483         return 0;
484 }
485
486 /*
487  *  0: display meaning of the statistics
488  * >0: retry limit
489  */
490 static ssize_t uv_ptc_proc_write(struct file *file, const char __user *user,
491                                  size_t count, loff_t *data)
492 {
493         long newmode;
494         char optstr[64];
495
496         if (count == 0 || count > sizeof(optstr))
497                 return -EINVAL;
498         if (copy_from_user(optstr, user, count))
499                 return -EFAULT;
500         optstr[count - 1] = '\0';
501         if (strict_strtoul(optstr, 10, &newmode) < 0) {
502                 printk(KERN_DEBUG "%s is invalid\n", optstr);
503                 return -EINVAL;
504         }
505
506         if (newmode == 0) {
507                 printk(KERN_DEBUG "# cpu:      cpu number\n");
508                 printk(KERN_DEBUG
509                 "requestor:  times this cpu was the flush requestor\n");
510                 printk(KERN_DEBUG
511                 "requestee:  times this cpu was requested to flush its TLBs\n");
512                 printk(KERN_DEBUG
513                 "one:        times requested to flush a single address\n");
514                 printk(KERN_DEBUG
515                 "all:        times requested to flush all TLB's\n");
516                 printk(KERN_DEBUG
517                 "sretry:     number of retries of source-side timeouts\n");
518                 printk(KERN_DEBUG
519                 "dretry:     number of retries of destination-side timeouts\n");
520                 printk(KERN_DEBUG
521                 "ptc_i:      times UV fell through to IPI-style flushes\n");
522                 printk(KERN_DEBUG
523                 "sw_ack:     image of UVH_LB_BAU_INTD_SOFTWARE_ACKNOWLEDGE\n");
524                 printk(KERN_DEBUG
525                 "sflush_us:  cycles spent in uv_flush_tlb_others()\n");
526                 printk(KERN_DEBUG
527                 "dflush_us:  cycles spent in handling flush requests\n");
528                 printk(KERN_DEBUG "sok:        successes on retry\n");
529                 printk(KERN_DEBUG "dnomsg:     interrupts with no message\n");
530                 printk(KERN_DEBUG
531                 "dmult:      interrupts with multiple messages\n");
532                 printk(KERN_DEBUG "starget:    nodes targeted\n");
533         } else {
534                 uv_bau_retry_limit = newmode;
535                 printk(KERN_DEBUG "timeout retry limit:%d\n",
536                        uv_bau_retry_limit);
537         }
538
539         return count;
540 }
541
542 static const struct seq_operations uv_ptc_seq_ops = {
543         .start          = uv_ptc_seq_start,
544         .next           = uv_ptc_seq_next,
545         .stop           = uv_ptc_seq_stop,
546         .show           = uv_ptc_seq_show
547 };
548
549 static int uv_ptc_proc_open(struct inode *inode, struct file *file)
550 {
551         return seq_open(file, &uv_ptc_seq_ops);
552 }
553
554 static const struct file_operations proc_uv_ptc_operations = {
555         .open           = uv_ptc_proc_open,
556         .read           = seq_read,
557         .write          = uv_ptc_proc_write,
558         .llseek         = seq_lseek,
559         .release        = seq_release,
560 };
561
562 static int __init uv_ptc_init(void)
563 {
564         struct proc_dir_entry *proc_uv_ptc;
565
566         if (!is_uv_system())
567                 return 0;
568
569         proc_uv_ptc = create_proc_entry(UV_PTC_BASENAME, 0444, NULL);
570         if (!proc_uv_ptc) {
571                 printk(KERN_ERR "unable to create %s proc entry\n",
572                        UV_PTC_BASENAME);
573                 return -EINVAL;
574         }
575         proc_uv_ptc->proc_fops = &proc_uv_ptc_operations;
576         return 0;
577 }
578
579 /*
580  * begin the initialization of the per-blade control structures
581  */
582 static struct bau_control * __init uv_table_bases_init(int blade, int node)
583 {
584         int i;
585         struct bau_msg_status *msp;
586         struct bau_control *bau_tabp;
587
588         bau_tabp =
589             kmalloc_node(sizeof(struct bau_control), GFP_KERNEL, node);
590         BUG_ON(!bau_tabp);
591
592         bau_tabp->msg_statuses =
593             kmalloc_node(sizeof(struct bau_msg_status) *
594                          DEST_Q_SIZE, GFP_KERNEL, node);
595         BUG_ON(!bau_tabp->msg_statuses);
596
597         for (i = 0, msp = bau_tabp->msg_statuses; i < DEST_Q_SIZE; i++, msp++)
598                 bau_cpubits_clear(&msp->seen_by, (int)
599                                   uv_blade_nr_possible_cpus(blade));
600
601         uv_bau_table_bases[blade] = bau_tabp;
602
603         return bau_tabp;
604 }
605
606 /*
607  * finish the initialization of the per-blade control structures
608  */
609 static void __init
610 uv_table_bases_finish(int blade, int node, int cur_cpu,
611                       struct bau_control *bau_tablesp,
612                       struct bau_desc *adp)
613 {
614         struct bau_control *bcp;
615         int i;
616
617         for (i = cur_cpu; i < cur_cpu + uv_blade_nr_possible_cpus(blade); i++) {
618                 bcp = (struct bau_control *)&per_cpu(bau_control, i);
619
620                 bcp->bau_msg_head       = bau_tablesp->va_queue_first;
621                 bcp->va_queue_first     = bau_tablesp->va_queue_first;
622                 bcp->va_queue_last      = bau_tablesp->va_queue_last;
623                 bcp->msg_statuses       = bau_tablesp->msg_statuses;
624                 bcp->descriptor_base    = adp;
625         }
626 }
627
628 /*
629  * initialize the sending side's sending buffers
630  */
631 static struct bau_desc * __init
632 uv_activation_descriptor_init(int node, int pnode)
633 {
634         int i;
635         unsigned long pa;
636         unsigned long m;
637         unsigned long n;
638         unsigned long mmr_image;
639         struct bau_desc *adp;
640         struct bau_desc *ad2;
641
642         adp = (struct bau_desc *)
643             kmalloc_node(16384, GFP_KERNEL, node);
644         BUG_ON(!adp);
645
646         pa = __pa((unsigned long)adp);
647         n = pa >> uv_nshift;
648         m = pa & uv_mmask;
649
650         mmr_image = uv_read_global_mmr64(pnode, UVH_LB_BAU_SB_DESCRIPTOR_BASE);
651         if (mmr_image) {
652                 uv_write_global_mmr64(pnode, (unsigned long)
653                                       UVH_LB_BAU_SB_DESCRIPTOR_BASE,
654                                       (n << UV_DESC_BASE_PNODE_SHIFT | m));
655         }
656
657         for (i = 0, ad2 = adp; i < UV_ACTIVATION_DESCRIPTOR_SIZE; i++, ad2++) {
658                 memset(ad2, 0, sizeof(struct bau_desc));
659                 ad2->header.sw_ack_flag = 1;
660                 ad2->header.base_dest_nodeid =
661                     uv_blade_to_pnode(uv_cpu_to_blade_id(0));
662                 ad2->header.command = UV_NET_ENDPOINT_INTD;
663                 ad2->header.int_both = 1;
664                 /*
665                  * all others need to be set to zero:
666                  *   fairness chaining multilevel count replied_to
667                  */
668         }
669         return adp;
670 }
671
672 /*
673  * initialize the destination side's receiving buffers
674  */
675 static struct bau_payload_queue_entry * __init
676 uv_payload_queue_init(int node, int pnode, struct bau_control *bau_tablesp)
677 {
678         struct bau_payload_queue_entry *pqp;
679         char *cp;
680
681         pqp = (struct bau_payload_queue_entry *) kmalloc_node(
682                 (DEST_Q_SIZE + 1) * sizeof(struct bau_payload_queue_entry),
683                 GFP_KERNEL, node);
684         BUG_ON(!pqp);
685
686         cp = (char *)pqp + 31;
687         pqp = (struct bau_payload_queue_entry *)(((unsigned long)cp >> 5) << 5);
688         bau_tablesp->va_queue_first = pqp;
689         uv_write_global_mmr64(pnode,
690                               UVH_LB_BAU_INTD_PAYLOAD_QUEUE_FIRST,
691                               ((unsigned long)pnode <<
692                                UV_PAYLOADQ_PNODE_SHIFT) |
693                               uv_physnodeaddr(pqp));
694         uv_write_global_mmr64(pnode, UVH_LB_BAU_INTD_PAYLOAD_QUEUE_TAIL,
695                               uv_physnodeaddr(pqp));
696         bau_tablesp->va_queue_last = pqp + (DEST_Q_SIZE - 1);
697         uv_write_global_mmr64(pnode, UVH_LB_BAU_INTD_PAYLOAD_QUEUE_LAST,
698                               (unsigned long)
699                               uv_physnodeaddr(bau_tablesp->va_queue_last));
700         memset(pqp, 0, sizeof(struct bau_payload_queue_entry) * DEST_Q_SIZE);
701
702         return pqp;
703 }
704
705 /*
706  * Initialization of each UV blade's structures
707  */
708 static int __init uv_init_blade(int blade, int node, int cur_cpu)
709 {
710         int pnode;
711         unsigned long pa;
712         unsigned long apicid;
713         struct bau_desc *adp;
714         struct bau_payload_queue_entry *pqp;
715         struct bau_control *bau_tablesp;
716
717         bau_tablesp = uv_table_bases_init(blade, node);
718         pnode = uv_blade_to_pnode(blade);
719         adp = uv_activation_descriptor_init(node, pnode);
720         pqp = uv_payload_queue_init(node, pnode, bau_tablesp);
721         uv_table_bases_finish(blade, node, cur_cpu, bau_tablesp, adp);
722         /*
723          * the below initialization can't be in firmware because the
724          * messaging IRQ will be determined by the OS
725          */
726         apicid = per_cpu(x86_cpu_to_apicid, cur_cpu);
727         pa = uv_read_global_mmr64(pnode, UVH_BAU_DATA_CONFIG);
728         if ((pa & 0xff) != UV_BAU_MESSAGE) {
729                 uv_write_global_mmr64(pnode, UVH_BAU_DATA_CONFIG,
730                                       ((apicid << 32) | UV_BAU_MESSAGE));
731         }
732         return 0;
733 }
734
735 /*
736  * Initialization of BAU-related structures
737  */
738 static int __init uv_bau_init(void)
739 {
740         int blade;
741         int node;
742         int nblades;
743         int last_blade;
744         int cur_cpu = 0;
745
746         if (!is_uv_system())
747                 return 0;
748
749         uv_bau_retry_limit = 1;
750         uv_nshift = uv_hub_info->n_val;
751         uv_mmask = (1UL << uv_hub_info->n_val) - 1;
752         nblades = 0;
753         last_blade = -1;
754         for_each_online_node(node) {
755                 blade = uv_node_to_blade_id(node);
756                 if (blade == last_blade)
757                         continue;
758                 last_blade = blade;
759                 nblades++;
760         }
761         uv_bau_table_bases = (struct bau_control **)
762             kmalloc(nblades * sizeof(struct bau_control *), GFP_KERNEL);
763         BUG_ON(!uv_bau_table_bases);
764
765         last_blade = -1;
766         for_each_online_node(node) {
767                 blade = uv_node_to_blade_id(node);
768                 if (blade == last_blade)
769                         continue;
770                 last_blade = blade;
771                 uv_init_blade(blade, node, cur_cpu);
772                 cur_cpu += uv_blade_nr_possible_cpus(blade);
773         }
774         alloc_intr_gate(UV_BAU_MESSAGE, uv_bau_message_intr1);
775         uv_enable_timeouts();
776
777         return 0;
778 }
779 __initcall(uv_bau_init);
780 __initcall(uv_ptc_init);