lunaix-os/hal/ahci/utils.c

   1 #include <hal/ahci/hba.h>
   2 #include <hal/ahci/utils.h>
   3 #include <klibc/string.h>
   4
   5 #define IDDEV_OFFMAXLBA 60
   6 #define IDDEV_OFFMAXLBA_EXT 230
   7 #define IDDEV_OFFLSECSIZE 117
   8 #define IDDEV_OFFWWN 108
   9 #define IDDEV_OFFSERIALNUM 10
  10 #define IDDEV_OFFMODELNUM 27
  11 #define IDDEV_OFFADDSUPPORT 69
  12
  13 void
  14 ahci_parse_dev_info(struct hba_device* dev_info, uint16_t* data)
  15 {
  16     dev_info->max_lba = *((uint32_t*)(data + IDDEV_OFFMAXLBA));
  17     dev_info->block_size = *((uint32_t*)(data + IDDEV_OFFLSECSIZE));
  18     dev_info->cbd_size = (*data & 0x3) ? 16 : 12;
  19     dev_info->wwn = *(uint64_t*)(data + IDDEV_OFFWWN);
  20
  21     if (!dev_info->block_size) {
  22         dev_info->block_size = 512;
  23     }
  24
  25     if ((*(data + IDDEV_OFFADDSUPPORT) & 0x8)) {
  26         dev_info->max_lba = *((uint64_t*)(data + IDDEV_OFFMAXLBA_EXT));
  27         dev_info->flags |= HBA_DEV_FEXTLBA;
  28     }
  29
  30     ahci_parsestr(&dev_info->serial_num, data + IDDEV_OFFSERIALNUM, 10);
  31     ahci_parsestr(&dev_info->model, data + IDDEV_OFFMODELNUM, 20);
  32 }
  33
  34 void
  35 ahci_parsestr(char* str, uint16_t* reg_start, int size_word)
  36 {
  37     int j = 0;
  38     for (int i = 0; i < size_word; i++, j += 2) {
  39         uint16_t reg = *(reg_start + i);
  40         str[j] = (char)(reg >> 8);
  41         str[j + 1] = (char)(reg & 0xff);
  42     }
  43     str[j - 1] = '\0';
  44 }