arch/m68k-all/processor/processor_init.c

   1 /*
   2     Copyright © 2011-2017, 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      * The inline assembler doesn't like the reference to the 68060 specific
  27      * PCR register.  So here we put the manually assembled code into ReadPCR[]
  28      * and later we'll call it from Supervisor() to retrieve that PCR register
  29      * contents.  The assembled code is:
  30      *
  31      *     movec PCR,d0      ; 4E7A0808
  32      *     rte               ; 4E73
  33      */
  34
  35     ULONG ReadPCR[2] = { 0x4E7A0808, 0x4E730000 };
  36     register ULONG pcr asm("d0");
  37
  38     __sprintf(info->ModelStringBuffer, "%s", "68000");
  39     info->ModelString = info->ModelStringBuffer;
  40
  41     info->CPUModel = CPUMODEL_68000;
  42     info->FPUModel = FPUMODEL_UNKNOWN;
  43     info->L1InstructionCacheSize = 0;
  44     info->L1DataCacheSize = 0;
  45
  46     pcr = 0;
  47
  48     if (SysBase->AttnFlags & (AFF_68060 | AFF_68080)) {
  49         pcr = Supervisor(ReadPCR);
  50     }
  51
  52     if (SysBase->AttnFlags & AFF_68080)
  53     {
  54         info->CPUModel = CPUMODEL_68080;
  55         // info->FPUModel = FPUMODEL_UNKNOWN;
  56         __sprintf(info->ModelStringBuffer, "%s", "Apollo Core 68080");
  57
  58         if (pcr & 0x04400000) {
  59             info->L1InstructionCacheSize = 16384;
  60             info->L1DataCacheSize = 32768;
  61         }
  62     }
  63     else if (SysBase->AttnFlags & AFF_68060)
  64     {
  65         info->CPUModel = CPUMODEL_68060;
  66         if (SysBase->AttnFlags & AFF_FPU40) {
  67             info->FPUModel = FPUMODEL_INTERNAL;
  68             __sprintf(info->ModelStringBuffer, "%s", "68060");
  69         } else {
  70             if (SysBase->AttnFlags  & AFB_PRIVATEB)
  71             {
  72                 __sprintf(info->ModelStringBuffer, "%s", "68LC060");
  73             }
  74             else
  75             {
  76                 __sprintf(info->ModelStringBuffer, "%s", "68EC060");
  77             }
  78         }
  79         info->L1InstructionCacheSize = 8192;
  80         info->L1DataCacheSize = 8192;
  81     }
  82     else if (SysBase->AttnFlags & AFF_68040)
  83     {
  84         info->CPUModel = CPUMODEL_68040;
  85         if (SysBase->AttnFlags & AFF_FPU40) {
  86             info->FPUModel = FPUMODEL_INTERNAL;
  87             __sprintf(info->ModelStringBuffer, "%s", "68040");
  88         } else {
  89             if (SysBase->AttnFlags  & AFB_PRIVATEB)
  90             {
  91                 __sprintf(info->ModelStringBuffer, "%s", "68LC040");
  92             }
  93             else
  94             {
  95                 __sprintf(info->ModelStringBuffer, "%s", "68EC040");
  96             }
  97         }
  98         info->L1InstructionCacheSize = 4096;
  99         info->L1DataCacheSize = 4096;
 100     }
 101     else if (SysBase->AttnFlags & AFF_68030)
 102     {
 103         info->CPUModel = CPUMODEL_68030;
 104         if (SysBase->AttnFlags  & AFB_PRIVATEB)
 105         {
 106             __sprintf(info->ModelStringBuffer, "%s", "68030");
 107         }
 108         else
 109         {
 110             __sprintf(info->ModelStringBuffer, "%s", "68EC030");
 111         }
 112         info->L1InstructionCacheSize = 256;
 113         info->L1DataCacheSize = 256;
 114     }
 115     else if (SysBase->AttnFlags & AFF_68020)
 116     {
 117         info->CPUModel = CPUMODEL_68020;
 118         if (SysBase->AttnFlags & AFF_ADDR32)
 119         {
 120             __sprintf(info->ModelStringBuffer, "%s", "68020");
 121         }
 122         else
 123         {
 124             __sprintf(info->ModelStringBuffer, "%s", "68EC020");
 125         }
 126         info->L1InstructionCacheSize = 256;
 127     }
 128     else if (SysBase->AttnFlags & AFF_68010)
 129     {
 130         info->CPUModel = CPUMODEL_68010;
 131         __sprintf(info->ModelStringBuffer, "%s", "68010");
 132     }
 133
 134     if (info->FPUModel != FPUMODEL_INTERNAL) {
 135         UBYTE *s = info->ModelStringBuffer;
 136         while (*s)
 137             s++;
 138         if (SysBase->AttnFlags & AFF_68882)
 139         {
 140             info->FPUModel = FPUMODEL_68882;
 141             __sprintf(s, "%s", "/68882");
 142         }
 143         else if (SysBase->AttnFlags & AFF_68881)
 144         {
 145             info->FPUModel = FPUMODEL_68881;
 146             __sprintf(s, "%s", "/68881");
 147         }
 148         else
 149             info->FPUModel = FPUMODEL_NONE;
 150     }
 151     info->CPUFrequency = 0; /* TODO: Implement */
 152 }
 153
 154 LONG Processor_Init(struct ProcessorBase * ProcessorBase)
 155 {
 156     struct SystemProcessors * sysprocs =
 157         AllocVec(sizeof(struct SystemProcessors), MEMF_ANY | MEMF_CLEAR);
 158
 159     if (sysprocs == NULL)
 160         return FALSE;
 161
 162     ProcessorBase->Private1 = sysprocs;
 163
 164     ReadProcessorInformation(&sysprocs->processor);
 165
 166     return TRUE;
 167 }
 168
 169 ADD2INITLIB(Processor_Init, 1);