arch/arm-all/processor/processor_init.c

   1 /*
   2     Copyright © 2013-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 0
   7 #include <aros/debug.h>
   8
   9 #include <proto/exec.h>
  10 #include <proto/kernel.h>
  11 #include <aros/symbolsets.h>
  12
  13 #include <resources/processor.h>
  14
  15 #include "processor_intern.h"
  16 #include "processor_arch_intern.h"
  17
  18 #define DUMPINFO(a) a
  19
  20 LONG Processor_Init(struct ProcessorBase * ProcessorBase)
  21 {
  22     struct ARMProcessorInformation **sysprocs;
  23     unsigned int i;
  24
  25     D(bug("[processor.ARM] :%s()\n", __PRETTY_FUNCTION__));
  26
  27     sysprocs = AllocVec(ProcessorBase->cpucount * sizeof(APTR), MEMF_ANY | MEMF_CLEAR);
  28     if ((ProcessorBase->Private1 = sysprocs) == NULL)
  29         return FALSE;
  30
  31     for (i = 0; i < ProcessorBase->cpucount; i++)
  32     {
  33         sysprocs[i] = AllocMem(sizeof(struct ARMProcessorInformation), MEMF_CLEAR);
  34         if (!sysprocs[i])
  35             return FALSE;
  36 #if defined(__AROSEXEC_SMP__)
  37         if (i > 0)
  38         {
  39             struct TagItem coreTags[] =
  40             {
  41                 {NP_Entry       ,  ReadProcessorInformation     },
  42                 {TASKTAG_AFFINITY       ,  (1<<i)                       },
  43                 {NP_UserData    ,  sysprocs[i]                  },
  44                 {TAG_DONE       , NULL                          }
  45             };
  46             CreateNewProc(coreTags);
  47         }
  48 #endif
  49     }
  50
  51     /* Boot CPU is number 0. Fill in its data. */
  52     ReadProcessorInformation(sysprocs[0]);
  53
  54     DUMPINFO(
  55         if (sysprocs[0]->FamilyString)
  56         {
  57             bug("[processor.ARM] %s ARM%s Processor Core\n", sysprocs[0]->Vendor, sysprocs[0]->FamilyString);
  58         }
  59         else
  60         {
  61             bug("[processor.ARM] %s ARM Processor Core (unknown family)\n", sysprocs[0]->Vendor);
  62         }
  63
  64         if (sysprocs[0]->Features1 & FEATF_FPU_VFP4)
  65         {
  66             bug("[processor.ARM] VFPv4 Co-Processor\n");
  67         }
  68         else if (sysprocs[0]->Features1 & FEATF_FPU_VFP3_16)
  69         {
  70             bug("[processor.ARM] VFPv3 [16Double] Co-Processor\n");
  71         }
  72         else if (sysprocs[0]->Features1 & FEATF_FPU_VFP3)
  73         {
  74             bug("[processor.ARM] VFPv3 Co-Processor\n");
  75         }
  76         else if (sysprocs[0]->Features1 & FEATF_FPU_VFP2)
  77         {
  78             bug("[processor.ARM] VFPv2 Co-Processor\n");
  79         }
  80         else
  81         {
  82             bug("[processor.ARM] VFPv1 Co-Processor\n");
  83         }
  84
  85         if (sysprocs[0]->Features1 & FEATF_NEON)
  86         {
  87             bug("[processor.ARM]   NEON SIMD Extensions\n");
  88         }
  89
  90         bug("[processor.ARM] Cache Info:\n");
  91         bug("[processor.ARM]   L1 Data   : %dKb\n", sysprocs[0]->L1DataCacheSize);
  92         bug("[processor.ARM]   L1 Instr. : %dKb\n", sysprocs[0]->L1InstructionCacheSize);
  93     )
  94
  95     return TRUE;
  96 }
  97
  98 ADD2INITLIB(Processor_Init, 1);