arch/m68k-all/m680x0/init.c

   1
   2 #include <aros/debug.h>
   3 #include <aros/libcall.h>
   4 #include <aros/symbolsets.h>
   5
   6 #include <proto/exec.h>
   7
   8 #include "m680x0_intern.h"
   9
  10 extern void sp060_init(void);
  11
  12 static AROS_UFH2(struct Library*, OpenLib,
  13     AROS_UFHA(ULONG, version, D0),
  14     AROS_UFHA(struct Library*, base, A6))
  15 {
  16     AROS_USERFUNC_INIT
  17
  18     base->lib_OpenCnt++;
  19     return base;
  20
  21     AROS_USERFUNC_EXIT
  22 }
  23
  24 static AROS_UFH1(void, CloseLib,
  25     AROS_UFHA(struct Library*, base, A6))
  26 {
  27     AROS_USERFUNC_INIT
  28
  29     base->lib_OpenCnt--;
  30
  31     AROS_USERFUNC_EXIT
  32 }
  33
  34 static AROS_UFH1(ULONG, DummyLib,
  35     AROS_UFHA(struct Library*, base, A6))
  36 {
  37     AROS_USERFUNC_INIT
  38
  39     return 0;
  40
  41     AROS_USERFUNC_EXIT
  42 }
  43
  44 /* This is totally undocumented so complain if something calls our functions */
  45 #define UNUSED(x) \
  46 static AROS_UFH1(ULONG, x, \
  47 AROS_UFHA(struct Library*, base, A6)) { \
  48     AROS_USERFUNC_INIT \
  49     bug("680x0: " #x "\n"); \
  50     return 0; \
  51     AROS_USERFUNC_EXIT \
  52 }
  53
  54 UNUSED(Unused5);
  55 UNUSED(Unused6);
  56 UNUSED(Unused7);
  57 UNUSED(Unused8);
  58 UNUSED(Unused9);
  59 UNUSED(Unused10);
  60 UNUSED(Unused11);
  61 UNUSED(Unused12);
  62 UNUSED(Unused13);
  63 UNUSED(Unused14);
  64 UNUSED(Unused15);
  65 UNUSED(Unused16);
  66
  67 static const APTR funcLib[] = {
  68         OpenLib, CloseLib, DummyLib, DummyLib,
  69         Unused5,
  70         Unused6,
  71         Unused7,
  72         Unused8,
  73         Unused9,
  74         Unused10,
  75         Unused11,
  76         Unused12,
  77         Unused13,
  78         Unused14,
  79         Unused15,
  80         Unused16,
  81         (void*)-1 };
  82
  83 static const UBYTE lib68040[] = "68040.library";
  84 static const UBYTE lib68060[] = "68060.library";
  85
  86 /* m68k identify.library calls these, purpose unknown */
  87 AROS_LH0(ULONG, Dummy1, struct M680x0Base*, M680x0Base, 5, m680x0)
  88 {
  89     AROS_LIBFUNC_INIT
  90     bug("680x0: dummy1\n");
  91     return 0;
  92     AROS_LIBFUNC_EXIT
  93 }
  94 AROS_LH0(ULONG, Dummy2, struct M680x0Base*, M680x0Base, 6, m680x0)
  95 {
  96     AROS_LIBFUNC_INIT
  97     bug("680x0: dummy2\n");
  98     return 0;
  99     AROS_LIBFUNC_EXIT
 100 }
 101 AROS_LH0(ULONG, Dummy3, struct M680x0Base*, M680x0Base, 7, m680x0)
 102 {
 103     AROS_LIBFUNC_INIT
 104     bug("680x0: dummy3\n");
 105     return 0;
 106     AROS_LIBFUNC_EXIT
 107 }
 108 AROS_LH0(ULONG, Dummy4, struct M680x0Base*, M680x0Base, 8, m680x0)
 109 {
 110     AROS_LIBFUNC_INIT
 111     bug("680x0: dummy4\n");
 112     return 0;
 113     AROS_LIBFUNC_EXIT
 114 }
 115
 116 static int M680x0Init(struct M680x0Base *M680x0Base)
 117 {
 118     struct Library *lib;
 119
 120     if (!(SysBase->AttnFlags & (AFF_68040 | AFF_68060)))
 121         return FALSE; /* 68040/060 only need emulation */
 122     if (SysBase->AttnFlags & AFF_68882)
 123         return FALSE; /* we already have full support? */
 124     if (!(SysBase->AttnFlags & AFF_FPU40))
 125         return FALSE; /* no FPU, don't bother with missing instruction emulation */
 126
 127     /* initialize emulation here */
 128     sp060_init();
 129
 130     /* Create fake 68040/060.library, stops C:SetPatch from attempting to load
 131      * incompatible 68040/060 libraries.
 132      *
 133      * We also create both 68040 and 68060.library if 68060 is detected, it prevents
 134      * old SetPatch versions (that do not know about 68060) from loading 68040.library.
 135      *
 136      * (Maybe this is getting too far..)
 137      */
 138     if (SysBase->AttnFlags & AFF_68060) {
 139         lib = MakeLibrary(funcLib, NULL, NULL, sizeof(struct Library), BNULL);
 140         if (lib) {
 141             lib->lib_Node.ln_Name = (UBYTE*)lib68060;
 142             lib->lib_IdString = lib->lib_Node.ln_Name;
 143             lib->lib_Version = M680x0Base->pb_LibNode.lib_Version;
 144             lib->lib_Revision = M680x0Base->pb_LibNode.lib_Revision;
 145             lib->lib_OpenCnt = 1;
 146             AddLibrary(lib);
 147         }
 148     }
 149     lib = MakeLibrary(funcLib, NULL, NULL, sizeof(struct Library), BNULL);
 150     if (lib) {
 151         lib->lib_Node.ln_Name = (UBYTE*)lib68040;
 152         lib->lib_IdString = lib->lib_Node.ln_Name;
 153         lib->lib_Version = M680x0Base->pb_LibNode.lib_Version;
 154         lib->lib_Revision = M680x0Base->pb_LibNode.lib_Revision;
 155         lib->lib_OpenCnt = 1;
 156         AddLibrary(lib);
 157     }
 158
 159     /* emulation installed, full 68881/68882 instruction set now supported  */
 160     SysBase->AttnFlags |= AFF_68881 | AFF_68882;
 161     /* do not expunge us */
 162     M680x0Base->pb_LibNode.lib_OpenCnt++;
 163     return TRUE;
 164 }
 165
 166 ADD2INITLIB(M680x0Init, 0)
 167
 168