1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * linux/arch/alpha/kernel/smp.c 4 * 5 * 2001-07-09 Phil Ezolt (Phillip.Ezolt@compaq.com) 6 * Renamed modified smp_call_function to smp_call_function_on_cpu() 7 * Created an function that conforms to the old calling convention 8 * of smp_call_function(). 9 * 10 * This is helpful for DCPI. 11 * 12 */ 13 14 #include <linux/errno.h> 15 #include <linux/kernel.h> 16 #include <linux/kernel_stat.h> 17 #include <linux/module.h> 18 #include <linux/sched/mm.h> 19 #include <linux/mm.h> 20 #include <linux/err.h> 21 #include <linux/threads.h> 22 #include <linux/smp.h> 23 #include <linux/interrupt.h> 24 #include <linux/init.h> 25 #include <linux/delay.h> 26 #include <linux/spinlock.h> 27 #include <linux/irq.h> 28 #include <linux/cache.h> 29 #include <linux/profile.h> 30 #include <linux/bitops.h> 31 #include <linux/cpu.h> 32 33 #include <asm/hwrpb.h> 34 #include <asm/ptrace.h> 35 #include <linux/atomic.h> 36 37 #include <asm/io.h> 38 #include <asm/irq.h> 39 #include <asm/mmu_context.h> 40 #include <asm/tlbflush.h> 41 42 #include "proto.h" 43 #include "irq_impl.h" 44 45 46 #define DEBUG_SMP 0 47 #if DEBUG_SMP 48 #define DBGS(args) printk args 49 #else 50 #define DBGS(args) 51 #endif 52 53 /* A collection of per-processor data. */ 54 struct cpuinfo_alpha cpu_data[NR_CPUS]; 55 EXPORT_SYMBOL(cpu_data); 56 57 /* A collection of single bit ipi messages. */ 58 static struct { 59 unsigned long bits ____cacheline_aligned; 60 } ipi_data[NR_CPUS] __cacheline_aligned; 61 62 enum ipi_message_type { 63 IPI_RESCHEDULE, 64 IPI_CALL_FUNC, 65 IPI_CPU_STOP, 66 }; 67 68 /* Set to a secondary's cpuid when it comes online. */ 69 static int smp_secondary_alive = 0; 70 71 int smp_num_probed; /* Internal processor count */ 72 int smp_num_cpus = 1; /* Number that came online. */ 73 EXPORT_SYMBOL(smp_num_cpus); 74 75 /* 76 * Called by both boot and secondaries to move global data into 77 * per-processor storage. 78 */ 79 static inline void __init 80 smp_store_cpu_info(int cpuid) 81 { 82 cpu_data[cpuid].loops_per_jiffy = loops_per_jiffy; 83 cpu_data[cpuid].last_asn = ASN_FIRST_VERSION; 84 cpu_data[cpuid].need_new_asn = 0; 85 cpu_data[cpuid].asn_lock = 0; 86 } 87 88 /* 89 * Ideally sets up per-cpu profiling hooks. Doesn't do much now... 90 */ 91 static inline void __init 92 smp_setup_percpu_timer(int cpuid) 93 { 94 cpu_data[cpuid].prof_counter = 1; 95 cpu_data[cpuid].prof_multiplier = 1; 96 } 97 98 static void __init 99 wait_boot_cpu_to_stop(int cpuid) 100 { 101 unsigned long stop = jiffies + 10*HZ; 102 103 while (time_before(jiffies, stop)) { 104 if (!smp_secondary_alive) 105 return; 106 barrier(); 107 } 108 109 printk("wait_boot_cpu_to_stop: FAILED on CPU %d, hanging now\n", cpuid); 110 for (;;) 111 barrier(); 112 } 113 114 /* 115 * Where secondaries begin a life of C. 116 */ 117 void __init 118 smp_callin(void) 119 { 120 int cpuid = hard_smp_processor_id(); 121 122 if (cpu_online(cpuid)) { 123 printk("??, cpu 0x%x already present??\n", cpuid); 124 BUG(); 125 } 126 set_cpu_online(cpuid, true); 127 128 /* Turn on machine checks. */ 129 wrmces(7); 130 131 /* Set trap vectors. */ 132 trap_init(); 133 134 /* Set interrupt vector. */ 135 wrent(entInt, 0); 136 137 /* Get our local ticker going. */ 138 smp_setup_percpu_timer(cpuid); 139 init_clockevent(); 140 141 /* Call platform-specific callin, if specified */ 142 if (alpha_mv.smp_callin) 143 alpha_mv.smp_callin(); 144 145 /* All kernel threads share the same mm context. */ 146 mmgrab(&init_mm); 147 current->active_mm = &init_mm; 148 149 /* inform the notifiers about the new cpu */ 150 notify_cpu_starting(cpuid); 151 152 /* Must have completely accurate bogos. */ 153 local_irq_enable(); 154 155 /* Wait boot CPU to stop with irq enabled before running 156 calibrate_delay. */ 157 wait_boot_cpu_to_stop(cpuid); 158 mb(); 159 calibrate_delay(); 160 161 smp_store_cpu_info(cpuid); 162 /* Allow master to continue only after we written loops_per_jiffy. */ 163 wmb(); 164 smp_secondary_alive = 1; 165 166 DBGS(("smp_callin: commencing CPU %d current %p active_mm %p\n", 167 cpuid, current, current->active_mm)); 168 169 cpu_startup_entry(CPUHP_AP_ONLINE_IDLE); 170 } 171 172 /* Wait until hwrpb->txrdy is clear for cpu. Return -1 on timeout. */ 173 static int 174 wait_for_txrdy (unsigned long cpumask) 175 { 176 unsigned long timeout; 177 178 if (!(hwrpb->txrdy & cpumask)) 179 return 0; 180 181 timeout = jiffies + 10*HZ; 182 while (time_before(jiffies, timeout)) { 183 if (!(hwrpb->txrdy & cpumask)) 184 return 0; 185 udelay(10); 186 barrier(); 187 } 188 189 return -1; 190 } 191 192 /* 193 * Send a message to a secondary's console. "START" is one such 194 * interesting message. ;-) 195 */ 196 static void 197 send_secondary_console_msg(char *str, int cpuid) 198 { 199 struct percpu_struct *cpu; 200 register char *cp1, *cp2; 201 unsigned long cpumask; 202 size_t len; 203 204 cpu = (struct percpu_struct *) 205 ((char*)hwrpb 206 + hwrpb->processor_offset 207 + cpuid * hwrpb->processor_size); 208 209 cpumask = (1UL << cpuid); 210 if (wait_for_txrdy(cpumask)) 211 goto timeout; 212 213 cp2 = str; 214 len = strlen(cp2); 215 *(unsigned int *)&cpu->ipc_buffer[0] = len; 216 cp1 = (char *) &cpu->ipc_buffer[1]; 217 memcpy(cp1, cp2, len); 218 219 /* atomic test and set */ 220 wmb(); 221 set_bit(cpuid, &hwrpb->rxrdy); 222 223 if (wait_for_txrdy(cpumask)) 224 goto timeout; 225 return; 226 227 timeout: 228 printk("Processor %x not ready\n", cpuid); 229 } 230 231 /* 232 * A secondary console wants to send a message. Receive it. 233 */ 234 static void 235 recv_secondary_console_msg(void) 236 { 237 int mycpu, i, cnt; 238 unsigned long txrdy = hwrpb->txrdy; 239 char *cp1, *cp2, buf[80]; 240 struct percpu_struct *cpu; 241 242 DBGS(("recv_secondary_console_msg: TXRDY 0x%lx.\n", txrdy)); 243 244 mycpu = hard_smp_processor_id(); 245 246 for (i = 0; i < NR_CPUS; i++) { 247 if (!(txrdy & (1UL << i))) 248 continue; 249 250 DBGS(("recv_secondary_console_msg: " 251 "TXRDY contains CPU %d.\n", i)); 252 253 cpu = (struct percpu_struct *) 254 ((char*)hwrpb 255 + hwrpb->processor_offset 256 + i * hwrpb->processor_size); 257 258 DBGS(("recv_secondary_console_msg: on %d from %d" 259 " HALT_REASON 0x%lx FLAGS 0x%lx\n", 260 mycpu, i, cpu->halt_reason, cpu->flags)); 261 262 cnt = cpu->ipc_buffer[0] >> 32; 263 if (cnt <= 0 || cnt >= 80) 264 strcpy(buf, "<<< BOGUS MSG >>>"); 265 else { 266 cp1 = (char *) &cpu->ipc_buffer[1]; 267 cp2 = buf; 268 memcpy(cp2, cp1, cnt); 269 cp2[cnt] = '\0'; 270 271 while ((cp2 = strchr(cp2, '\r')) != 0) { 272 *cp2 = ' '; 273 if (cp2[1] == '\n') 274 cp2[1] = ' '; 275 } 276 } 277 278 DBGS((KERN_INFO "recv_secondary_console_msg: on %d " 279 "message is '%s'\n", mycpu, buf)); 280 } 281 282 hwrpb->txrdy = 0; 283 } 284 285 /* 286 * Convince the console to have a secondary cpu begin execution. 287 */ 288 static int 289 secondary_cpu_start(int cpuid, struct task_struct *idle) 290 { 291 struct percpu_struct *cpu; 292 struct pcb_struct *hwpcb, *ipcb; 293 unsigned long timeout; 294 295 cpu = (struct percpu_struct *) 296 ((char*)hwrpb 297 + hwrpb->processor_offset 298 + cpuid * hwrpb->processor_size); 299 hwpcb = (struct pcb_struct *) cpu->hwpcb; 300 ipcb = &task_thread_info(idle)->pcb; 301 302 /* Initialize the CPU's HWPCB to something just good enough for 303 us to get started. Immediately after starting, we'll swpctx 304 to the target idle task's pcb. Reuse the stack in the mean 305 time. Precalculate the target PCBB. */ 306 hwpcb->ksp = (unsigned long)ipcb + sizeof(union thread_union) - 16; 307 hwpcb->usp = 0; 308 hwpcb->ptbr = ipcb->ptbr; 309 hwpcb->pcc = 0; 310 hwpcb->asn = 0; 311 hwpcb->unique = virt_to_phys(ipcb); 312 hwpcb->flags = ipcb->flags; 313 hwpcb->res1 = hwpcb->res2 = 0; 314 315 #if 0 316 DBGS(("KSP 0x%lx PTBR 0x%lx VPTBR 0x%lx UNIQUE 0x%lx\n", 317 hwpcb->ksp, hwpcb->ptbr, hwrpb->vptb, hwpcb->unique)); 318 #endif 319 DBGS(("Starting secondary cpu %d: state 0x%lx pal_flags 0x%lx\n", 320 cpuid, idle->state, ipcb->flags)); 321 322 /* Setup HWRPB fields that SRM uses to activate secondary CPU */ 323 hwrpb->CPU_restart = __smp_callin; 324 hwrpb->CPU_restart_data = (unsigned long) __smp_callin; 325 326 /* Recalculate and update the HWRPB checksum */ 327 hwrpb_update_checksum(hwrpb); 328 329 /* 330 * Send a "start" command to the specified processor. 331 */ 332 333 /* SRM III 3.4.1.3 */ 334 cpu->flags |= 0x22; /* turn on Context Valid and Restart Capable */ 335 cpu->flags &= ~1; /* turn off Bootstrap In Progress */ 336 wmb(); 337 338 send_secondary_console_msg("START\r\n", cpuid); 339 340 /* Wait 10 seconds for an ACK from the console. */ 341 timeout = jiffies + 10*HZ; 342 while (time_before(jiffies, timeout)) { 343 if (cpu->flags & 1) 344 goto started; 345 udelay(10); 346 barrier(); 347 } 348 printk(KERN_ERR "SMP: Processor %d failed to start.\n", cpuid); 349 return -1; 350 351 started: 352 DBGS(("secondary_cpu_start: SUCCESS for CPU %d!!!\n", cpuid)); 353 return 0; 354 } 355 356 /* 357 * Bring one cpu online. 358 */ 359 static int 360 smp_boot_one_cpu(int cpuid, struct task_struct *idle) 361 { 362 unsigned long timeout; 363 364 /* Signal the secondary to wait a moment. */ 365 smp_secondary_alive = -1; 366 367 /* Whirrr, whirrr, whirrrrrrrrr... */ 368 if (secondary_cpu_start(cpuid, idle)) 369 return -1; 370 371 /* Notify the secondary CPU it can run calibrate_delay. */ 372 mb(); 373 smp_secondary_alive = 0; 374 375 /* We've been acked by the console; wait one second for 376 the task to start up for real. */ 377 timeout = jiffies + 1*HZ; 378 while (time_before(jiffies, timeout)) { 379 if (smp_secondary_alive == 1) 380 goto alive; 381 udelay(10); 382 barrier(); 383 } 384 385 /* We failed to boot the CPU. */ 386 387 printk(KERN_ERR "SMP: Processor %d is stuck.\n", cpuid); 388 return -1; 389 390 alive: 391 /* Another "Red Snapper". */ 392 return 0; 393 } 394 395 /* 396 * Called from setup_arch. Detect an SMP system and which processors 397 * are present. 398 */ 399 void __init 400 setup_smp(void) 401 { 402 struct percpu_struct *cpubase, *cpu; 403 unsigned long i; 404 405 if (boot_cpuid != 0) { 406 printk(KERN_WARNING "SMP: Booting off cpu %d instead of 0?\n", 407 boot_cpuid); 408 } 409 410 if (hwrpb->nr_processors > 1) { 411 int boot_cpu_palrev; 412 413 DBGS(("setup_smp: nr_processors %ld\n", 414 hwrpb->nr_processors)); 415 416 cpubase = (struct percpu_struct *) 417 ((char*)hwrpb + hwrpb->processor_offset); 418 boot_cpu_palrev = cpubase->pal_revision; 419 420 for (i = 0; i < hwrpb->nr_processors; i++) { 421 cpu = (struct percpu_struct *) 422 ((char *)cpubase + i*hwrpb->processor_size); 423 if ((cpu->flags & 0x1cc) == 0x1cc) { 424 smp_num_probed++; 425 set_cpu_possible(i, true); 426 set_cpu_present(i, true); 427 cpu->pal_revision = boot_cpu_palrev; 428 } 429 430 DBGS(("setup_smp: CPU %d: flags 0x%lx type 0x%lx\n", 431 i, cpu->flags, cpu->type)); 432 DBGS(("setup_smp: CPU %d: PAL rev 0x%lx\n", 433 i, cpu->pal_revision)); 434 } 435 } else { 436 smp_num_probed = 1; 437 } 438 439 printk(KERN_INFO "SMP: %d CPUs probed -- cpu_present_mask = %lx\n", 440 smp_num_probed, cpumask_bits(cpu_present_mask)[0]); 441 } 442 443 /* 444 * Called by smp_init prepare the secondaries 445 */ 446 void __init 447 smp_prepare_cpus(unsigned int max_cpus) 448 { 449 /* Take care of some initial bookkeeping. */ 450 memset(ipi_data, 0, sizeof(ipi_data)); 451 452 current_thread_info()->cpu = boot_cpuid; 453 454 smp_store_cpu_info(boot_cpuid); 455 smp_setup_percpu_timer(boot_cpuid); 456 457 /* Nothing to do on a UP box, or when told not to. */ 458 if (smp_num_probed == 1 || max_cpus == 0) { 459 init_cpu_possible(cpumask_of(boot_cpuid)); 460 init_cpu_present(cpumask_of(boot_cpuid)); 461 printk(KERN_INFO "SMP mode deactivated.\n"); 462 return; 463 } 464 465 printk(KERN_INFO "SMP starting up secondaries.\n"); 466 467 smp_num_cpus = smp_num_probed; 468 } 469 470 void 471 smp_prepare_boot_cpu(void) 472 { 473 } 474 475 int 476 __cpu_up(unsigned int cpu, struct task_struct *tidle) 477 { 478 smp_boot_one_cpu(cpu, tidle); 479 480 return cpu_online(cpu) ? 0 : -ENOSYS; 481 } 482 483 void __init 484 smp_cpus_done(unsigned int max_cpus) 485 { 486 int cpu; 487 unsigned long bogosum = 0; 488 489 for(cpu = 0; cpu < NR_CPUS; cpu++) 490 if (cpu_online(cpu)) 491 bogosum += cpu_data[cpu].loops_per_jiffy; 492 493 printk(KERN_INFO "SMP: Total of %d processors activated " 494 "(%lu.%02lu BogoMIPS).\n", 495 num_online_cpus(), 496 (bogosum + 2500) / (500000/HZ), 497 ((bogosum + 2500) / (5000/HZ)) % 100); 498 } 499 500 static void 501 send_ipi_message(const struct cpumask *to_whom, enum ipi_message_type operation) 502 { 503 int i; 504 505 mb(); 506 for_each_cpu(i, to_whom) 507 set_bit(operation, &ipi_data[i].bits); 508 509 mb(); 510 for_each_cpu(i, to_whom) 511 wripir(i); 512 } 513 514 void 515 handle_ipi(struct pt_regs *regs) 516 { 517 int this_cpu = smp_processor_id(); 518 unsigned long *pending_ipis = &ipi_data[this_cpu].bits; 519 unsigned long ops; 520 521 #if 0 522 DBGS(("handle_ipi: on CPU %d ops 0x%lx PC 0x%lx\n", 523 this_cpu, *pending_ipis, regs->pc)); 524 #endif 525 526 mb(); /* Order interrupt and bit testing. */ 527 while ((ops = xchg(pending_ipis, 0)) != 0) { 528 mb(); /* Order bit clearing and data access. */ 529 do { 530 unsigned long which; 531 532 which = ops & -ops; 533 ops &= ~which; 534 which = __ffs(which); 535 536 switch (which) { 537 case IPI_RESCHEDULE: 538 scheduler_ipi(); 539 break; 540 541 case IPI_CALL_FUNC: 542 generic_smp_call_function_interrupt(); 543 break; 544 545 case IPI_CPU_STOP: 546 halt(); 547 548 default: 549 printk(KERN_CRIT "Unknown IPI on CPU %d: %lu\n", 550 this_cpu, which); 551 break; 552 } 553 } while (ops); 554 555 mb(); /* Order data access and bit testing. */ 556 } 557 558 cpu_data[this_cpu].ipi_count++; 559 560 if (hwrpb->txrdy) 561 recv_secondary_console_msg(); 562 } 563 564 void 565 smp_send_reschedule(int cpu) 566 { 567 #ifdef DEBUG_IPI_MSG 568 if (cpu == hard_smp_processor_id()) 569 printk(KERN_WARNING 570 "smp_send_reschedule: Sending IPI to self.\n"); 571 #endif 572 send_ipi_message(cpumask_of(cpu), IPI_RESCHEDULE); 573 } 574 575 void 576 smp_send_stop(void) 577 { 578 cpumask_t to_whom; 579 cpumask_copy(&to_whom, cpu_online_mask); 580 cpumask_clear_cpu(smp_processor_id(), &to_whom); 581 #ifdef DEBUG_IPI_MSG 582 if (hard_smp_processor_id() != boot_cpu_id) 583 printk(KERN_WARNING "smp_send_stop: Not on boot cpu.\n"); 584 #endif 585 send_ipi_message(&to_whom, IPI_CPU_STOP); 586 } 587 588 void arch_send_call_function_ipi_mask(const struct cpumask *mask) 589 { 590 send_ipi_message(mask, IPI_CALL_FUNC); 591 } 592 593 void arch_send_call_function_single_ipi(int cpu) 594 { 595 send_ipi_message(cpumask_of(cpu), IPI_CALL_FUNC); 596 } 597 598 static void 599 ipi_imb(void *ignored) 600 { 601 imb(); 602 } 603 604 void 605 smp_imb(void) 606 { 607 /* Must wait other processors to flush their icache before continue. */ 608 on_each_cpu(ipi_imb, NULL, 1); 609 } 610 EXPORT_SYMBOL(smp_imb); 611 612 static void 613 ipi_flush_tlb_all(void *ignored) 614 { 615 tbia(); 616 } 617 618 void 619 flush_tlb_all(void) 620 { 621 /* Although we don't have any data to pass, we do want to 622 synchronize with the other processors. */ 623 on_each_cpu(ipi_flush_tlb_all, NULL, 1); 624 } 625 626 #define asn_locked() (cpu_data[smp_processor_id()].asn_lock) 627 628 static void 629 ipi_flush_tlb_mm(void *x) 630 { 631 struct mm_struct *mm = (struct mm_struct *) x; 632 if (mm == current->active_mm && !asn_locked()) 633 flush_tlb_current(mm); 634 else 635 flush_tlb_other(mm); 636 } 637 638 void 639 flush_tlb_mm(struct mm_struct *mm) 640 { 641 preempt_disable(); 642 643 if (mm == current->active_mm) { 644 flush_tlb_current(mm); 645 if (atomic_read(&mm->mm_users) <= 1) { 646 int cpu, this_cpu = smp_processor_id(); 647 for (cpu = 0; cpu < NR_CPUS; cpu++) { 648 if (!cpu_online(cpu) || cpu == this_cpu) 649 continue; 650 if (mm->context[cpu]) 651 mm->context[cpu] = 0; 652 } 653 preempt_enable(); 654 return; 655 } 656 } 657 658 smp_call_function(ipi_flush_tlb_mm, mm, 1); 659 660 preempt_enable(); 661 } 662 EXPORT_SYMBOL(flush_tlb_mm); 663 664 struct flush_tlb_page_struct { 665 struct vm_area_struct *vma; 666 struct mm_struct *mm; 667 unsigned long addr; 668 }; 669 670 static void 671 ipi_flush_tlb_page(void *x) 672 { 673 struct flush_tlb_page_struct *data = (struct flush_tlb_page_struct *)x; 674 struct mm_struct * mm = data->mm; 675 676 if (mm == current->active_mm && !asn_locked()) 677 flush_tlb_current_page(mm, data->vma, data->addr); 678 else 679 flush_tlb_other(mm); 680 } 681 682 void 683 flush_tlb_page(struct vm_area_struct *vma, unsigned long addr) 684 { 685 struct flush_tlb_page_struct data; 686 struct mm_struct *mm = vma->vm_mm; 687 688 preempt_disable(); 689 690 if (mm == current->active_mm) { 691 flush_tlb_current_page(mm, vma, addr); 692 if (atomic_read(&mm->mm_users) <= 1) { 693 int cpu, this_cpu = smp_processor_id(); 694 for (cpu = 0; cpu < NR_CPUS; cpu++) { 695 if (!cpu_online(cpu) || cpu == this_cpu) 696 continue; 697 if (mm->context[cpu]) 698 mm->context[cpu] = 0; 699 } 700 preempt_enable(); 701 return; 702 } 703 } 704 705 data.vma = vma; 706 data.mm = mm; 707 data.addr = addr; 708 709 smp_call_function(ipi_flush_tlb_page, &data, 1); 710 711 preempt_enable(); 712 } 713 EXPORT_SYMBOL(flush_tlb_page); 714 715 void 716 flush_tlb_range(struct vm_area_struct *vma, unsigned long start, unsigned long end) 717 { 718 /* On the Alpha we always flush the whole user tlb. */ 719 flush_tlb_mm(vma->vm_mm); 720 } 721 EXPORT_SYMBOL(flush_tlb_range); 722 723 static void 724 ipi_flush_icache_page(void *x) 725 { 726 struct mm_struct *mm = (struct mm_struct *) x; 727 if (mm == current->active_mm && !asn_locked()) 728 __load_new_mm_context(mm); 729 else 730 flush_tlb_other(mm); 731 } 732 733 void 734 flush_icache_user_page(struct vm_area_struct *vma, struct page *page, 735 unsigned long addr, int len) 736 { 737 struct mm_struct *mm = vma->vm_mm; 738 739 if ((vma->vm_flags & VM_EXEC) == 0) 740 return; 741 742 preempt_disable(); 743 744 if (mm == current->active_mm) { 745 __load_new_mm_context(mm); 746 if (atomic_read(&mm->mm_users) <= 1) { 747 int cpu, this_cpu = smp_processor_id(); 748 for (cpu = 0; cpu < NR_CPUS; cpu++) { 749 if (!cpu_online(cpu) || cpu == this_cpu) 750 continue; 751 if (mm->context[cpu]) 752 mm->context[cpu] = 0; 753 } 754 preempt_enable(); 755 return; 756 } 757 } 758 759 smp_call_function(ipi_flush_icache_page, mm, 1); 760 761 preempt_enable(); 762 } 763