rom/usb/poseidon/usbromstartup.c

   1 /* Very basic bootstrap for Poseidon in AROS kernel for enabling of USB booting and HID devices.
   2  * PsdStackloader should be started during startup-sequence nonetheless */
   3
   4 #include <aros/asmcall.h>
   5 #include <aros/debug.h>
   6 #include <aros/symbolsets.h>
   7 #include <exec/resident.h>
   8 #include <proto/poseidon.h>
   9 #include <proto/exec.h>
  10
  11 int __startup usbromstartup_entry(void)
  12 {
  13     return -1;
  14 }
  15
  16 static const char name[];
  17 static const char version[];
  18 static const UBYTE endptr;
  19
  20 AROS_UFP3(static IPTR, usbromstartup_init,
  21     AROS_UFHA(ULONG, dummy, D0),
  22     AROS_UFHA(BPTR, seglist, A0),
  23     AROS_UFHA(struct ExecBase *, SysBase, A6));
  24
  25 const struct Resident usbHook =
  26 {
  27     RTC_MATCHWORD,
  28     (struct Resident *)&usbHook,
  29     (APTR)&endptr,
  30     RTF_COLDSTART,
  31     41,
  32     NT_TASK,
  33     35,
  34     name,
  35     &version[5],
  36     (APTR)usbromstartup_init
  37 };
  38
  39 static const char name[] = "Poseidon ROM starter";
  40 static const char version[] = "$VER:Poseidon ROM startup v41.1";
  41
  42 AROS_UFH3(static IPTR, usbromstartup_init,
  43     AROS_UFHA(ULONG, dummy, D0),
  44     AROS_UFHA(BPTR, seglist, A0),
  45     AROS_UFHA(struct ExecBase *, SysBase, A6))
  46 {
  47     AROS_USERFUNC_INIT
  48
  49     struct Library *ps;
  50     struct PsdHardware *phw;
  51     ULONG cnt = 0;
  52
  53     D(bug("[USBROMStartup] Loading poseidon...\n"));
  54
  55     if((ps = OpenLibrary("poseidon.library", 4)))
  56     {
  57         APTR msdclass;
  58         IPTR usecount = 0;
  59         ULONG bootdelay = 4;
  60
  61         D(bug("[USBROMStartup] Adding classes...\n"));
  62
  63         psdAddClass("hub.class", 0);
  64         if(!(psdAddClass("hid.class", 0)))
  65         {
  66             psdAddClass("bootmouse.class", 0);
  67             psdAddClass("bootkeyboard.class", 0);
  68         }
  69         msdclass = psdAddClass("massstorage.class", 0);
  70
  71         /* now this finds all usb hardware pci cards */
  72         while((phw = psdAddHardware("pciusb.device", cnt)))
  73         {
  74             D(bug("[USBROMStartup] Added pciusb.device unit %u\n", cnt));
  75
  76             psdEnumerateHardware(phw);
  77             cnt++;
  78         }
  79
  80         D(bug("[USBROMStartup] Scanning classes...\n"));
  81         psdClassScan();
  82
  83         if(msdclass)
  84         {
  85             psdDelayMS(1000); // wait for hubs to settle
  86             psdGetAttrs(PGA_USBCLASS, msdclass, UCA_UseCount, &usecount, TAG_END);
  87             if(usecount > 0)
  88             {
  89                 psdAddErrorMsg(RETURN_OK, (STRPTR)name,
  90                                "Delaying further execution by %ld second(s) (boot delay).",
  91                                bootdelay);
  92                 if(bootdelay > 1)
  93                 {
  94                     psdDelayMS((bootdelay-1)*1000);
  95                 }
  96             } else {
  97                 psdAddErrorMsg(RETURN_OK, (STRPTR)name, "Boot delay skipped, no mass storage devices found.");
  98             }
  99         }
 100
 101         CloseLibrary(ps);
 102     }
 103     return 0;
 104
 105     AROS_USERFUNC_EXIT
 106 }
 107
 108 static const UBYTE endptr = 0;