Author: marcel
Date: Fri Aug  5 22:54:42 2011
New Revision: 224661
URL: http://svn.freebsd.org/changeset/base/224661

Log:
  Make octeon_ap_boot 64 bits to handle MAXCPU up to 64.
  Better construction of CPU mask in platform_cpu_mask().
  Release cores still in reset when platform_start_ap() is called.
  
  Reviewed by: imp, marcel
  Obtained from: Juniper Networks, Inc
  Author: Andrew Duane
  Approved by: re (kib)

Modified:
  head/sys/mips/cavium/asm_octeon.S
  head/sys/mips/cavium/octeon_mp.c

Modified: head/sys/mips/cavium/asm_octeon.S
==============================================================================
--- head/sys/mips/cavium/asm_octeon.S   Fri Aug  5 17:43:11 2011        
(r224660)
+++ head/sys/mips/cavium/asm_octeon.S   Fri Aug  5 22:54:42 2011        
(r224661)
@@ -50,12 +50,12 @@ LEAF(octeon_ap_wait)
        jal     platform_processor_id
        nop
 
-1:     ll      t0, octeon_ap_boot
+1:     lld     t0, octeon_ap_boot
        bne     v0, t0, 1b
        nop
 
        move    t0, zero
-       sc      t0, octeon_ap_boot
+       scd     t0, octeon_ap_boot
 
        beqz    t0, 1b
        nop

Modified: head/sys/mips/cavium/octeon_mp.c
==============================================================================
--- head/sys/mips/cavium/octeon_mp.c    Fri Aug  5 17:43:11 2011        
(r224660)
+++ head/sys/mips/cavium/octeon_mp.c    Fri Aug  5 22:54:42 2011        
(r224661)
@@ -46,7 +46,8 @@ __FBSDID("$FreeBSD$");
 /* XXX */
 extern cvmx_bootinfo_t *octeon_bootinfo;
 
-unsigned octeon_ap_boot = ~0;
+/* NOTE: this 64-bit mask (and many others) limits MAXCPU to 64 */
+uint64_t octeon_ap_boot = ~0ULL;
 
 void
 platform_ipi_send(int cpuid)
@@ -105,15 +106,13 @@ platform_init_ap(int cpuid)
 void
 platform_cpu_mask(cpuset_t *mask)
 {
+       uint64_t core_mask = octeon_bootinfo->core_mask;
+       uint64_t i, m;
 
        CPU_ZERO(mask);
-
-       /*
-        * XXX: hack in order to simplify CPU set building, assuming that
-        * core_mask is 32-bits.
-        */
-       memcpy(mask, &octeon_bootinfo->core_mask,
-           sizeof(octeon_bootinfo->core_mask));
+       for (i = 0, m = 1 ; i < MAXCPU; i++, m <<= 1)
+               if (core_mask & m)
+                       CPU_SET(i, mask);
 }
 
 struct cpu_group *
@@ -125,11 +124,26 @@ platform_smp_topo(void)
 int
 platform_start_ap(int cpuid)
 {
-       if (atomic_cmpset_32(&octeon_ap_boot, ~0, cpuid) == 0)
+       uint64_t cores_in_reset;
+
+       /* 
+        * Release the core if it is in reset, and let it rev up a bit.
+        * The real synchronization happens below via octeon_ap_boot.
+        */
+       cores_in_reset = cvmx_read_csr(CVMX_CIU_PP_RST);
+       if (cores_in_reset & (1ULL << cpuid)) {
+           if (bootverbose)
+               printf ("AP #%d still in reset\n", cpuid);
+           cores_in_reset &= ~(1ULL << cpuid);
+           cvmx_write_csr(CVMX_CIU_PP_RST, (uint64_t)(cores_in_reset));
+           DELAY(2000);    /* Give it a moment to start */
+       }
+
+       if (atomic_cmpset_64(&octeon_ap_boot, ~0, cpuid) == 0)
                return (-1);
        for (;;) {
                DELAY(1000);
-               if (atomic_cmpset_32(&octeon_ap_boot, 0, ~0) != 0)
+               if (atomic_cmpset_64(&octeon_ap_boot, 0, ~0) != 0)
                        return (0);
                printf("Waiting for cpu%d to start\n", cpuid);
        }
_______________________________________________
[email protected] mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "[email protected]"

Reply via email to