2 * Intel(R) Matrix Storage Manager hardware and firmware support routines
4 * Copyright (C) 2008 Intel Corporation
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
15 * You should have received a copy of the GNU General Public License along with
16 * this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
20 #include "platform-intel.h"
21 #include "probe_roms.h"
29 #include <sys/types.h>
33 static int devpath_to_ll(const char *dev_path
, const char *entry
,
34 unsigned long long *val
);
36 static __u16
devpath_to_vendor(const char *dev_path
);
38 static void free_sys_dev(struct sys_dev
**list
)
41 struct sys_dev
*next
= (*list
)->next
;
50 struct sys_dev
*find_driver_devices(const char *bus
, const char *driver
)
52 /* search sysfs for devices driven by 'driver' */
58 struct sys_dev
*head
= NULL
;
59 struct sys_dev
*list
= NULL
;
60 enum sys_dev_type type
;
61 unsigned long long dev_id
;
62 unsigned long long class;
64 if (strcmp(driver
, "isci") == 0)
66 else if (strcmp(driver
, "ahci") == 0)
68 else if (strcmp(driver
, "nvme") == 0)
71 type
= SYS_DEV_UNKNOWN
;
73 sprintf(path
, "/sys/bus/%s/drivers/%s", bus
, driver
);
74 driver_dir
= opendir(path
);
77 for (de
= readdir(driver_dir
); de
; de
= readdir(driver_dir
)) {
80 /* is 'de' a device? check that the 'subsystem' link exists and
81 * that its target matches 'bus'
83 sprintf(path
, "/sys/bus/%s/drivers/%s/%s/subsystem",
84 bus
, driver
, de
->d_name
);
85 n
= readlink(path
, link
, sizeof(link
));
86 if (n
< 0 || n
>= (int)sizeof(link
))
89 c
= strrchr(link
, '/');
92 if (strncmp(bus
, c
+1, strlen(bus
)) != 0)
95 sprintf(path
, "/sys/bus/%s/drivers/%s/%s",
96 bus
, driver
, de
->d_name
);
98 /* if it's not Intel device skip it. */
99 if (devpath_to_vendor(path
) != 0x8086)
102 if (devpath_to_ll(path
, "device", &dev_id
) != 0)
105 if (devpath_to_ll(path
, "class", &class) != 0)
108 /* start / add list entry */
110 head
= xmalloc(sizeof(*head
));
113 list
->next
= xmalloc(sizeof(*head
));
122 list
->dev_id
= (__u16
) dev_id
;
123 list
->class = (__u32
) class;
125 list
->path
= realpath(path
, NULL
);
127 if ((list
->pci_id
= strrchr(list
->path
, '/')) != NULL
)
130 closedir(driver_dir
);
134 static struct sys_dev
*intel_devices
=NULL
;
135 static time_t valid_time
= 0;
137 static int devpath_to_ll(const char *dev_path
, const char *entry
, unsigned long long *val
)
139 char path
[strlen(dev_path
) + strlen(entry
) + 2];
143 sprintf(path
, "%s/%s", dev_path
, entry
);
145 fd
= open(path
, O_RDONLY
);
148 n
= sysfs_fd_get_ll(fd
, val
);
153 static __u16
devpath_to_vendor(const char *dev_path
)
155 char path
[strlen(dev_path
) + strlen("/vendor") + 1];
161 sprintf(path
, "%s/vendor", dev_path
);
163 fd
= open(path
, O_RDONLY
);
167 n
= read(fd
, vendor
, sizeof(vendor
));
168 if (n
== sizeof(vendor
)) {
169 vendor
[n
- 1] = '\0';
170 id
= strtoul(vendor
, NULL
, 16);
177 struct sys_dev
*find_intel_devices(void)
179 struct sys_dev
*ahci
, *isci
, *nvme
;
181 if (valid_time
> time(0) - 10)
182 return intel_devices
;
185 free_sys_dev(&intel_devices
);
187 isci
= find_driver_devices("pci", "isci");
188 ahci
= find_driver_devices("pci", "ahci");
189 nvme
= find_driver_devices("pci", "nvme");
191 if (!isci
&& !ahci
) {
195 struct sys_dev
*elem
= ahci
;
200 struct sys_dev
*elem
= ahci
;
208 intel_devices
= ahci
;
209 valid_time
= time(0);
210 return intel_devices
;
214 * PCI Expansion ROM Data Structure Format */
215 struct pciExpDataStructFormat
{
220 } __attribute__ ((packed
));
224 struct devid_list
*next
;
228 struct imsm_orom orom
;
229 struct devid_list
*devid_list
;
232 static struct orom_entry oroms
[SYS_DEV_MAX
];
234 const struct imsm_orom
*get_orom_by_device_id(__u16 dev_id
)
237 struct devid_list
*list
;
239 for (i
= 0; i
< SYS_DEV_MAX
; i
++) {
240 for (list
= oroms
[i
].devid_list
; list
; list
= list
->next
) {
241 if (list
->devid
== dev_id
)
242 return &oroms
[i
].orom
;
248 static const struct imsm_orom
*add_orom(const struct imsm_orom
*orom
)
252 for (i
= 0; i
< SYS_DEV_MAX
; i
++) {
253 if (&oroms
[i
].orom
== orom
)
255 if (oroms
[i
].orom
.signature
[0] == 0) {
256 oroms
[i
].orom
= *orom
;
257 return &oroms
[i
].orom
;
263 static void add_orom_device_id(const struct imsm_orom
*orom
, __u16 dev_id
)
266 struct devid_list
*list
;
267 struct devid_list
*prev
= NULL
;
269 for (i
= 0; i
< SYS_DEV_MAX
; i
++) {
270 if (&oroms
[i
].orom
== orom
) {
271 for (list
= oroms
[i
].devid_list
; list
; prev
= list
, list
= list
->next
) {
272 if (list
->devid
== dev_id
)
275 list
= xmalloc(sizeof(struct devid_list
));
276 list
->devid
= dev_id
;
280 oroms
[i
].devid_list
= list
;
288 static int scan(const void *start
, const void *end
, const void *data
)
291 const struct imsm_orom
*imsm_mem
= NULL
;
292 int len
= (end
- start
);
293 struct pciExpDataStructFormat
*ptr
= (struct pciExpDataStructFormat
*)data
;
295 if (data
+ 0x18 > end
) {
296 dprintf("cannot find pciExpDataStruct \n");
300 dprintf("ptr->vendorID: %lx __le16_to_cpu(ptr->deviceID): %lx \n",
301 (ulong
) __le16_to_cpu(ptr
->vendorID
),
302 (ulong
) __le16_to_cpu(ptr
->deviceID
));
304 if (__le16_to_cpu(ptr
->vendorID
) != 0x8086)
307 for (offset
= 0; offset
< len
; offset
+= 4) {
308 const void *mem
= start
+ offset
;
310 if ((memcmp(mem
, IMSM_OROM_SIGNATURE
, 4) == 0)) {
319 const struct imsm_orom
*orom
= add_orom(imsm_mem
);
321 if (ptr
->devListOffset
) {
322 const __u16
*dev_list
= (void *)ptr
+ ptr
->devListOffset
;
325 for (i
= 0; dev_list
[i
] != 0; i
++)
326 add_orom_device_id(orom
, dev_list
[i
]);
328 add_orom_device_id(orom
, __le16_to_cpu(ptr
->deviceID
));
334 const struct imsm_orom
*imsm_platform_test(struct sys_dev
*hba
)
336 struct imsm_orom orom
= {
337 .signature
= IMSM_OROM_SIGNATURE
,
338 .rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
339 IMSM_OROM_RLC_RAID10
| IMSM_OROM_RLC_RAID5
,
340 .sss
= IMSM_OROM_SSS_4kB
| IMSM_OROM_SSS_8kB
|
341 IMSM_OROM_SSS_16kB
| IMSM_OROM_SSS_32kB
|
342 IMSM_OROM_SSS_64kB
| IMSM_OROM_SSS_128kB
|
343 IMSM_OROM_SSS_256kB
| IMSM_OROM_SSS_512kB
|
344 IMSM_OROM_SSS_1MB
| IMSM_OROM_SSS_2MB
,
345 .dpa
= IMSM_OROM_DISKS_PER_ARRAY
,
346 .tds
= IMSM_OROM_TOTAL_DISKS
,
347 .vpa
= IMSM_OROM_VOLUMES_PER_ARRAY
,
348 .vphba
= IMSM_OROM_VOLUMES_PER_HBA
350 orom
.attr
= orom
.rlc
| IMSM_OROM_ATTR_ChecksumVerify
;
352 if (check_env("IMSM_TEST_OROM_NORAID5")) {
353 orom
.rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
354 IMSM_OROM_RLC_RAID10
;
356 if (check_env("IMSM_TEST_AHCI_EFI_NORAID5") && (hba
->type
== SYS_DEV_SAS
)) {
357 orom
.rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
358 IMSM_OROM_RLC_RAID10
;
360 if (check_env("IMSM_TEST_SCU_EFI_NORAID5") && (hba
->type
== SYS_DEV_SATA
)) {
361 orom
.rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
362 IMSM_OROM_RLC_RAID10
;
365 const struct imsm_orom
*ret
= add_orom(&orom
);
367 add_orom_device_id(ret
, hba
->dev_id
);
372 static const struct imsm_orom
*find_imsm_hba_orom(struct sys_dev
*hba
)
376 if (check_env("IMSM_TEST_OROM"))
377 return imsm_platform_test(hba
);
379 /* return empty OROM capabilities in EFI test mode */
380 if (check_env("IMSM_TEST_AHCI_EFI") || check_env("IMSM_TEST_SCU_EFI"))
383 find_intel_devices();
385 if (intel_devices
== NULL
)
388 /* scan option-rom memory looking for an imsm signature */
389 if (check_env("IMSM_SAFE_OROM_SCAN"))
393 if (probe_roms_init(align
) != 0)
396 /* ignore return value - True is returned if both adapater roms are found */
397 scan_adapter_roms(scan
);
400 return get_orom_by_device_id(hba
->dev_id
);
403 #define GUID_STR_MAX 37 /* according to GUID format:
404 * xxxxxxxx-xxxx-xxxx-xxxx-xxxxxxxxxxxx" */
406 #define EFI_GUID(a, b, c, d0, d1, d2, d3, d4, d5, d6, d7) \
408 {{ (a) & 0xff, ((a) >> 8) & 0xff, ((a) >> 16) & 0xff, ((a) >> 24) & 0xff, \
409 (b) & 0xff, ((b) >> 8) & 0xff, \
410 (c) & 0xff, ((c) >> 8) & 0xff, \
411 (d0), (d1), (d2), (d3), (d4), (d5), (d6), (d7) }})
413 #define SYS_EFI_VAR_PATH "/sys/firmware/efi/vars"
414 #define SCU_PROP "RstScuV"
415 #define AHCI_PROP "RstSataV"
416 #define AHCI_SSATA_PROP "RstsSatV"
417 #define AHCI_CSATA_PROP "RstCSatV"
419 #define VENDOR_GUID \
420 EFI_GUID(0x193dfefa, 0xa445, 0x4302, 0x99, 0xd8, 0xef, 0x3a, 0xad, 0x1a, 0x04, 0xc6)
422 #define PCI_CLASS_RAID_CNTRL 0x010400
424 int read_efi_variable(void *buffer
, ssize_t buf_size
, char *variable_name
, struct efi_guid guid
)
427 char buf
[GUID_STR_MAX
];
429 ssize_t n
, var_data_len
;
431 snprintf(path
, PATH_MAX
, "%s/%s-%s/size", SYS_EFI_VAR_PATH
, variable_name
, guid_str(buf
, guid
));
433 dprintf("EFI VAR: path=%s\n", path
);
434 /* get size of variable data */
435 dfd
= open(path
, O_RDONLY
);
439 n
= read(dfd
, &buf
, sizeof(buf
));
446 var_data_len
= strtoul(buf
, NULL
, 16);
447 if ((errno
== ERANGE
&& (var_data_len
== LONG_MAX
))
448 || (errno
!= 0 && var_data_len
== 0))
452 snprintf(path
, PATH_MAX
, "%s/%s-%s/data", SYS_EFI_VAR_PATH
, variable_name
, guid_str(buf
, guid
));
454 dprintf("EFI VAR: path=%s\n", path
);
455 dfd
= open(path
, O_RDONLY
);
459 n
= read(dfd
, buffer
, buf_size
);
461 if (n
!= var_data_len
|| n
< buf_size
) {
468 const struct imsm_orom
*find_imsm_efi(struct sys_dev
*hba
)
470 struct imsm_orom orom
;
471 const struct imsm_orom
*ret
;
474 if (check_env("IMSM_TEST_AHCI_EFI") || check_env("IMSM_TEST_SCU_EFI"))
475 return imsm_platform_test(hba
);
477 /* OROM test is set, return that there is no EFI capabilities */
478 if (check_env("IMSM_TEST_OROM"))
481 if (hba
->type
== SYS_DEV_SATA
&& hba
->class != PCI_CLASS_RAID_CNTRL
)
484 err
= read_efi_variable(&orom
, sizeof(orom
), hba
->type
== SYS_DEV_SAS
? SCU_PROP
: AHCI_PROP
, VENDOR_GUID
);
486 /* try to read variable for second AHCI controller */
487 if (err
&& hba
->type
== SYS_DEV_SATA
)
488 err
= read_efi_variable(&orom
, sizeof(orom
), AHCI_SSATA_PROP
, VENDOR_GUID
);
490 /* try to read variable for combined AHCI controllers */
491 if (err
&& hba
->type
== SYS_DEV_SATA
) {
492 static const struct imsm_orom
*csata
;
494 err
= read_efi_variable(&orom
, sizeof(orom
), AHCI_CSATA_PROP
, VENDOR_GUID
);
497 csata
= add_orom(&orom
);
498 add_orom_device_id(csata
, hba
->dev_id
);
506 ret
= add_orom(&orom
);
507 add_orom_device_id(ret
, hba
->dev_id
);
512 const struct imsm_orom
*find_imsm_nvme(struct sys_dev
*hba
)
514 static const struct imsm_orom
*nvme_orom
;
516 if (hba
->type
!= SYS_DEV_NVME
)
520 struct imsm_orom nvme_orom_compat
= {
521 .signature
= IMSM_NVME_OROM_COMPAT_SIGNATURE
,
522 .rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
523 IMSM_OROM_RLC_RAID10
| IMSM_OROM_RLC_RAID5
,
524 .sss
= IMSM_OROM_SSS_4kB
| IMSM_OROM_SSS_8kB
|
525 IMSM_OROM_SSS_16kB
| IMSM_OROM_SSS_32kB
|
526 IMSM_OROM_SSS_64kB
| IMSM_OROM_SSS_128kB
,
527 .dpa
= IMSM_OROM_DISKS_PER_ARRAY_NVME
,
528 .tds
= IMSM_OROM_TOTAL_DISKS_NVME
,
529 .vpa
= IMSM_OROM_VOLUMES_PER_ARRAY
,
530 .vphba
= IMSM_OROM_TOTAL_DISKS_NVME
/ 2 * IMSM_OROM_VOLUMES_PER_ARRAY
,
531 .attr
= IMSM_OROM_ATTR_2TB
| IMSM_OROM_ATTR_2TB_DISK
,
533 nvme_orom
= add_orom(&nvme_orom_compat
);
535 add_orom_device_id(nvme_orom
, hba
->dev_id
);
539 const struct imsm_orom
*find_imsm_capability(struct sys_dev
*hba
)
541 const struct imsm_orom
*cap
= get_orom_by_device_id(hba
->dev_id
);
546 if (hba
->type
== SYS_DEV_NVME
)
547 return find_imsm_nvme(hba
);
548 if ((cap
= find_imsm_efi(hba
)) != NULL
)
550 if ((cap
= find_imsm_hba_orom(hba
)) != NULL
)
556 char *devt_to_devpath(dev_t dev
)
560 sprintf(device
, "/sys/dev/block/%d:%d/device", major(dev
), minor(dev
));
561 return realpath(device
, NULL
);
564 char *diskfd_to_devpath(int fd
)
566 /* return the device path for a disk, return NULL on error or fd
567 * refers to a partition
571 if (fstat(fd
, &st
) != 0)
573 if (!S_ISBLK(st
.st_mode
))
576 return devt_to_devpath(st
.st_rdev
);
579 int path_attached_to_hba(const char *disk_path
, const char *hba_path
)
583 if (check_env("IMSM_TEST_AHCI_DEV") ||
584 check_env("IMSM_TEST_SCU_DEV")) {
588 if (!disk_path
|| !hba_path
)
590 dprintf("hba: %s - disk: %s\n", hba_path
, disk_path
);
591 if (strncmp(disk_path
, hba_path
, strlen(hba_path
)) == 0)
599 int devt_attached_to_hba(dev_t dev
, const char *hba_path
)
601 char *disk_path
= devt_to_devpath(dev
);
602 int rc
= path_attached_to_hba(disk_path
, hba_path
);
610 int disk_attached_to_hba(int fd
, const char *hba_path
)
612 char *disk_path
= diskfd_to_devpath(fd
);
613 int rc
= path_attached_to_hba(disk_path
, hba_path
);