lunaix-os/kernel/fs/probe_boot.c

   1 #include <lunaix/fs/iso9660.h>
   2 #include <lunaix/fs/probe_boot.h>
   3 #include <lunaix/mm/valloc.h>
   4 #include <lunaix/syslog.h>
   5
   6 LOG_MODULE("PROBE")
   7
   8 #define LUNAIX_ID 0x414e554cUL // "LUNA"
   9
  10 struct device*
  11 probe_boot_medium()
  12 {
  13     struct device* block_cat = device_getbyname(NULL, "block", 5);
  14     if (!block_cat) {
  15         return NULL;
  16     }
  17
  18     struct iso_vol_primary* volp = valloc(ISO9660_BLKSZ);
  19
  20     struct device *pos, *n;
  21     llist_for_each(pos, n, &block_cat->children, siblings)
  22     {
  23         int errno =
  24           pos->ops.read(pos, (void*)volp, ISO9660_READ_OFF, ISO9660_BLKSZ);
  25         if (errno < 0) {
  26             kprintf(KWARN "can not probe %x:%s (%d)\n",
  27                     pos->dev_id,
  28                     pos->name.value,
  29                     errno);
  30             pos = NULL;
  31             goto done;
  32         }
  33
  34         if (*(u32_t*)volp->header.std_id != ISO_SIGNATURE_LO) {
  35             continue;
  36         }
  37
  38         if (*(u32_t*)volp->sys_id == LUNAIX_ID) {
  39             kprintf(KINFO "[%x:%s] %s\n",
  40                     pos->dev_id,
  41                     pos->name.value,
  42                     (char*)volp->vol_id);
  43             break;
  44         }
  45     }
  46
  47 done:
  48     vfree(volp);
  49     return pos;
  50 }