arch/arm-native/kernel/getcpucount.c

   1 /*
   2     Copyright © 2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/kernel.h>
   7 #include <aros/libcall.h>
   8
   9 #include "kernel_base.h"
  10 #include "kernel_intern.h"
  11
  12 AROS_LH0(cpuid_t, KrnGetCPUCount,
  13          struct KernelBase *, KernelBase, 40, Kernel)
  14 {
  15     AROS_LIBFUNC_INIT
  16
  17     cpuid_t count;
  18
  19     count = __arm_arosintern.ARMI_AffinityMask
  20         - ((__arm_arosintern.ARMI_AffinityMask >> 1) & 0x55555555);
  21     count = (count & 0x33333333) + ((count >> 2) & 0x33333333);
  22     return (((count + (count >> 4)) & 0x0F0F0F0F) * 0x01010101) >> 24;
  23
  24     return count;
  25
  26     AROS_LIBFUNC_EXIT
  27 }