arch/m68k-all/processor/processor_init.c

   1 /*
   2     Copyright © 2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <exec/rawfmt.h>
   7 #include <proto/exec.h>
   8 #include <stdarg.h>
   9 #include <aros/symbolsets.h>
  10
  11 #include "processor_intern.h"
  12 #include "processor_arch_intern.h"
  13
  14 static VOID  __sprintf(UBYTE *buffer, const UBYTE *format, ...)
  15 {
  16     va_list args;
  17
  18     va_start(args, format);
  19     VNewRawDoFmt(format, RAWFMTFUNC_STRING, buffer, args);
  20     va_end(args);
  21 }
  22
  23 static VOID ReadProcessorInformation(struct M68KProcessorInformation * info)
  24 {
  25
  26     __sprintf(info->ModelStringBuffer, "%s", "Unknown");
  27     info->ModelString = info->ModelStringBuffer;
  28
  29     info->CPUModel = CPUMODEL_UNKNOWN;
  30     info->FPUModel = FPUMODEL_UNKNOWN;
  31     info->L1InstructionCacheSize = 0;
  32     info->L1DataCacheSize = 0;
  33
  34     if (SysBase->AttnFlags & AFF_68060)
  35     {
  36         info->CPUModel = CPUMODEL_68060;
  37         __sprintf(info->ModelStringBuffer, "%s", "68060");
  38         info->L1InstructionCacheSize = 8192;
  39         info->L1DataCacheSize = 8192;
  40     }
  41     else if (SysBase->AttnFlags & AFF_68040)
  42     {
  43         info->CPUModel = CPUMODEL_68040;
  44         __sprintf(info->ModelStringBuffer, "%s", "68040");
  45         info->L1InstructionCacheSize = 4096;
  46         info->L1DataCacheSize = 4096;
  47     }
  48     else if (SysBase->AttnFlags & AFF_68030)
  49     {
  50         info->CPUModel = CPUMODEL_68030;
  51         __sprintf(info->ModelStringBuffer, "%s", "68030");
  52         info->L1InstructionCacheSize = 256;
  53         info->L1DataCacheSize = 256;
  54     }
  55     else if (SysBase->AttnFlags & AFF_68020)
  56     {
  57         info->CPUModel = CPUMODEL_68020;
  58         __sprintf(info->ModelStringBuffer, "%s", "68020");
  59         info->L1InstructionCacheSize = 256;
  60     }
  61     else if (SysBase->AttnFlags & AFF_68010)
  62     {
  63         info->CPUModel = CPUMODEL_68010;
  64         __sprintf(info->ModelStringBuffer, "%s", "68010");
  65     }
  66     else
  67     {
  68         info->CPUModel = CPUMODEL_68000;
  69         __sprintf(info->ModelStringBuffer, "%s", "68000");
  70     }
  71
  72     if (SysBase->AttnFlags & AFF_FPU40) {
  73         if (SysBase->AttnFlags & AFF_68060)
  74         {
  75             info->FPUModel = FPUMODEL_INTERNAL;
  76             __sprintf(info->ModelStringBuffer + 5, "%s", " + FPU");
  77         }
  78         else if (SysBase->AttnFlags & AFF_68040)
  79         {
  80             info->FPUModel = FPUMODEL_INTERNAL;
  81             __sprintf(info->ModelStringBuffer + 5, "%s", " + FPU");
  82         }
  83         else
  84             info->FPUModel = FPUMODEL_NONE;
  85     }
  86     else if (SysBase->AttnFlags & AFF_68882)
  87     {
  88         info->FPUModel = FPUMODEL_68882;
  89         __sprintf(info->ModelStringBuffer + 5, "%s", " + 68882");
  90     }
  91     else if (SysBase->AttnFlags & AFF_68881)
  92     {
  93         info->FPUModel = FPUMODEL_68881;
  94         __sprintf(info->ModelStringBuffer + 5, "%s", " + 68881");
  95     }
  96     else
  97         info->FPUModel = FPUMODEL_NONE;
  98
  99     info->CPUFrequency = 0; /* TODO: Implement */
 100 }
 101
 102 LONG Processor_Init(struct ProcessorBase * ProcessorBase)
 103 {
 104     struct SystemProcessors * sysprocs =
 105         AllocVec(sizeof(struct SystemProcessors), MEMF_ANY | MEMF_CLEAR);
 106
 107     if (sysprocs == NULL)
 108         return FALSE;
 109
 110     ProcessorBase->Private1 = sysprocs;
 111
 112     ReadProcessorInformation(&sysprocs->processor);
 113
 114     return TRUE;
 115 }
 116
 117 ADD2INITLIB(Processor_Init, 1);