lunaix-os/hal/ahci/utils.c

   1 #include <hal/ahci/utils.h>
   2 #include <klibc/string.h>
   3
   4 #define IDDEV_MAXLBA_OFFSET 60
   5 #define IDDEV_LSECSIZE_OFFSET 117
   6 #define IDDEV_WWN_OFFSET 108
   7 #define IDDEV_SERIALNUM_OFFSET 10
   8 #define IDDEV_MODELNUM_OFFSET 27
   9
  10 void
  11 ahci_parse_dev_info(struct ahci_device_info* dev_info, uint16_t* data)
  12 {
  13     dev_info->max_lba = *((uint32_t*)(data + IDDEV_MAXLBA_OFFSET));
  14     dev_info->sector_size = *((uint32_t*)(data + IDDEV_LSECSIZE_OFFSET));
  15     memcpy(&dev_info->wwn, (uint8_t*)(data + IDDEV_WWN_OFFSET), 8);
  16     if (!dev_info->sector_size) {
  17         dev_info->sector_size = 512;
  18     }
  19     ahci_parsestr(&dev_info->serial_num, data + IDDEV_SERIALNUM_OFFSET, 10);
  20     ahci_parsestr(&dev_info->model, data + IDDEV_MODELNUM_OFFSET, 20);
  21 }
  22
  23 void
  24 ahci_parsestr(char* str, uint16_t* reg_start, int size_word)
  25 {
  26     for (int i = 0, j = 0; i < size_word; i++, j += 2) {
  27         uint16_t reg = *(reg_start + i);
  28         str[j] = (char)(reg >> 8);
  29         str[j + 1] = (char)(reg & 0xff);
  30     }
  31 }