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>
34 static int devpath_to_ll(const char *dev_path
, const char *entry
,
35 unsigned long long *val
);
37 static __u16
devpath_to_vendor(const char *dev_path
);
39 void free_sys_dev(struct sys_dev
**list
)
42 struct sys_dev
*next
= (*list
)->next
;
51 struct sys_dev
*find_driver_devices(const char *bus
, const char *driver
)
53 /* search sysfs for devices driven by 'driver' */
59 struct sys_dev
*head
= NULL
;
60 struct sys_dev
*list
= NULL
;
61 enum sys_dev_type type
;
62 unsigned long long dev_id
;
64 if (strcmp(driver
, "isci") == 0)
66 else if (strcmp(driver
, "ahci") == 0)
69 type
= SYS_DEV_UNKNOWN
;
71 sprintf(path
, "/sys/bus/%s/drivers/%s", bus
, driver
);
72 driver_dir
= opendir(path
);
75 for (de
= readdir(driver_dir
); de
; de
= readdir(driver_dir
)) {
78 /* is 'de' a device? check that the 'subsystem' link exists and
79 * that its target matches 'bus'
81 sprintf(path
, "/sys/bus/%s/drivers/%s/%s/subsystem",
82 bus
, driver
, de
->d_name
);
83 n
= readlink(path
, link
, sizeof(link
));
84 if (n
< 0 || n
>= (int)sizeof(link
))
87 c
= strrchr(link
, '/');
90 if (strncmp(bus
, c
+1, strlen(bus
)) != 0)
93 sprintf(path
, "/sys/bus/%s/drivers/%s/%s",
94 bus
, driver
, de
->d_name
);
96 /* if it's not Intel device skip it. */
97 if (devpath_to_vendor(path
) != 0x8086)
100 if (devpath_to_ll(path
, "device", &dev_id
) != 0)
103 /* start / add list entry */
105 head
= malloc(sizeof(*head
));
108 list
->next
= malloc(sizeof(*head
));
117 list
->dev_id
= (__u16
) dev_id
;
119 list
->path
= canonicalize_file_name(path
);
121 if ((list
->pci_id
= strrchr(list
->path
, '/')) != NULL
)
124 closedir(driver_dir
);
129 static struct sys_dev
*intel_devices
=NULL
;
131 static enum sys_dev_type
device_type_by_id(__u16 device_id
)
133 struct sys_dev
*iter
;
135 for(iter
= intel_devices
; iter
!= NULL
; iter
= iter
->next
)
136 if (iter
->dev_id
== device_id
)
138 return SYS_DEV_UNKNOWN
;
141 static int devpath_to_ll(const char *dev_path
, const char *entry
, unsigned long long *val
)
143 char path
[strlen(dev_path
) + strlen(entry
) + 2];
147 sprintf(path
, "%s/%s", dev_path
, entry
);
149 fd
= open(path
, O_RDONLY
);
152 n
= sysfs_fd_get_ll(fd
, val
);
158 static __u16
devpath_to_vendor(const char *dev_path
)
160 char path
[strlen(dev_path
) + strlen("/vendor") + 1];
166 sprintf(path
, "%s/vendor", dev_path
);
168 fd
= open(path
, O_RDONLY
);
172 n
= read(fd
, vendor
, sizeof(vendor
));
173 if (n
== sizeof(vendor
)) {
174 vendor
[n
- 1] = '\0';
175 id
= strtoul(vendor
, NULL
, 16);
182 struct sys_dev
*find_intel_devices(void)
184 struct sys_dev
*ahci
, *isci
;
186 isci
= find_driver_devices("pci", "isci");
187 ahci
= find_driver_devices("pci", "ahci");
192 struct sys_dev
*elem
= ahci
;
201 * PCI Expansion ROM Data Structure Format */
202 struct pciExpDataStructFormat
{
206 } __attribute__ ((packed
));
208 static struct imsm_orom imsm_orom
[SYS_DEV_MAX
];
209 static int populated_orom
[SYS_DEV_MAX
];
211 static int scan(const void *start
, const void *end
, const void *data
)
214 const struct imsm_orom
*imsm_mem
;
216 int len
= (end
- start
);
217 struct pciExpDataStructFormat
*ptr
= (struct pciExpDataStructFormat
*)data
;
219 if (data
+ 0x18 > end
) {
220 dprintf("cannot find pciExpDataStruct \n");
224 dprintf("ptr->vendorID: %lx __le16_to_cpu(ptr->deviceID): %lx \n",
225 (ulong
) __le16_to_cpu(ptr
->vendorID
),
226 (ulong
) __le16_to_cpu(ptr
->deviceID
));
228 if (__le16_to_cpu(ptr
->vendorID
) == 0x8086) {
229 /* serach attached intel devices by device id from OROM */
230 dev
= device_type_by_id(__le16_to_cpu(ptr
->deviceID
));
231 if (dev
== SYS_DEV_UNKNOWN
)
237 for (offset
= 0; offset
< len
; offset
+= 4) {
238 imsm_mem
= start
+ offset
;
239 if ((memcmp(imsm_mem
->signature
, "$VER", 4) == 0)) {
240 imsm_orom
[dev
] = *imsm_mem
;
241 populated_orom
[dev
] = 1;
242 return populated_orom
[SYS_DEV_SATA
] && populated_orom
[SYS_DEV_SAS
];
249 const struct imsm_orom
*imsm_platform_test(enum sys_dev_type hba_id
, int *populated
,
250 struct imsm_orom
*imsm_orom
)
252 memset(imsm_orom
, 0, sizeof(*imsm_orom
));
253 imsm_orom
->rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
254 IMSM_OROM_RLC_RAID10
| IMSM_OROM_RLC_RAID5
;
255 imsm_orom
->sss
= IMSM_OROM_SSS_4kB
| IMSM_OROM_SSS_8kB
|
256 IMSM_OROM_SSS_16kB
| IMSM_OROM_SSS_32kB
|
257 IMSM_OROM_SSS_64kB
| IMSM_OROM_SSS_128kB
|
258 IMSM_OROM_SSS_256kB
| IMSM_OROM_SSS_512kB
|
259 IMSM_OROM_SSS_1MB
| IMSM_OROM_SSS_2MB
;
260 imsm_orom
->dpa
= IMSM_OROM_DISKS_PER_ARRAY
;
261 imsm_orom
->tds
= IMSM_OROM_TOTAL_DISKS
;
262 imsm_orom
->vpa
= IMSM_OROM_VOLUMES_PER_ARRAY
;
263 imsm_orom
->vphba
= IMSM_OROM_VOLUMES_PER_HBA
;
264 imsm_orom
->attr
= imsm_orom
->rlc
| IMSM_OROM_ATTR_ChecksumVerify
;
267 if (check_env("IMSM_TEST_OROM_NORAID5")) {
268 imsm_orom
->rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
269 IMSM_OROM_RLC_RAID10
;
271 if (check_env("IMSM_TEST_AHCI_EFI_NORAID5") && (hba_id
== SYS_DEV_SAS
)) {
272 imsm_orom
->rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
273 IMSM_OROM_RLC_RAID10
;
275 if (check_env("IMSM_TEST_SCU_EFI_NORAID5") && (hba_id
== SYS_DEV_SATA
)) {
276 imsm_orom
->rlc
= IMSM_OROM_RLC_RAID0
| IMSM_OROM_RLC_RAID1
|
277 IMSM_OROM_RLC_RAID10
;
285 static const struct imsm_orom
*find_imsm_hba_orom(enum sys_dev_type hba_id
)
289 if (hba_id
>= SYS_DEV_MAX
)
292 /* it's static data so we only need to read it once */
293 if (populated_orom
[hba_id
]) {
294 dprintf("OROM CAP: %p, pid: %d pop: %d\n",
295 &imsm_orom
[hba_id
], (int) getpid(), populated_orom
[hba_id
]);
296 return &imsm_orom
[hba_id
];
298 if (check_env("IMSM_TEST_OROM")) {
299 dprintf("OROM CAP: %p, pid: %d pop: %d\n",
300 &imsm_orom
[hba_id
], (int) getpid(), populated_orom
[hba_id
]);
301 return imsm_platform_test(hba_id
, &populated_orom
[hba_id
], &imsm_orom
[hba_id
]);
303 /* return empty OROM capabilities in EFI test mode */
304 if (check_env("IMSM_TEST_AHCI_EFI") ||
305 check_env("IMSM_TEST_SCU_EFI"))
309 if (intel_devices
!= NULL
)
310 free_sys_dev(&intel_devices
);
312 intel_devices
= find_intel_devices();
314 if (intel_devices
== NULL
)
317 /* scan option-rom memory looking for an imsm signature */
318 if (check_env("IMSM_SAFE_OROM_SCAN"))
322 if (probe_roms_init(align
) != 0)
325 /* ignore return value - True is returned if both adapater roms are found */
326 scan_adapter_roms(scan
);
329 if (intel_devices
!= NULL
)
330 free_sys_dev(&intel_devices
);
331 intel_devices
= NULL
;
333 if (populated_orom
[hba_id
])
334 return &imsm_orom
[hba_id
];
338 #define GUID_STR_MAX 37 /* according to GUID format:
339 * xxxxxxxx-xxxx-xxxx-xxxx-xxxxxxxxxxxx" */
341 #define EFI_GUID(a, b, c, d0, d1, d2, d3, d4, d5, d6, d7) \
343 {{ (a) & 0xff, ((a) >> 8) & 0xff, ((a) >> 16) & 0xff, ((a) >> 24) & 0xff, \
344 (b) & 0xff, ((b) >> 8) & 0xff, \
345 (c) & 0xff, ((c) >> 8) & 0xff, \
346 (d0), (d1), (d2), (d3), (d4), (d5), (d6), (d7) }})
349 #define SYS_EFI_VAR_PATH "/sys/firmware/efi/vars"
350 #define SCU_PROP "RstScuV"
351 #define AHCI_PROP "RstSataV"
353 #define VENDOR_GUID \
354 EFI_GUID(0x193dfefa, 0xa445, 0x4302, 0x99, 0xd8, 0xef, 0x3a, 0xad, 0x1a, 0x04, 0xc6)
356 int populated_efi
[SYS_DEV_MAX
] = { 0, 0 };
358 static struct imsm_orom imsm_efi
[SYS_DEV_MAX
];
360 int read_efi_variable(void *buffer
, ssize_t buf_size
, char *variable_name
, struct efi_guid guid
)
363 char buf
[GUID_STR_MAX
];
365 ssize_t n
, var_data_len
;
367 snprintf(path
, PATH_MAX
, "%s/%s-%s/size", SYS_EFI_VAR_PATH
, variable_name
, guid_str(buf
, guid
));
369 dprintf("EFI VAR: path=%s\n", path
);
370 /* get size of variable data */
371 dfd
= open(path
, O_RDONLY
);
375 n
= read(dfd
, &buf
, sizeof(buf
));
382 var_data_len
= strtoul(buf
, NULL
, 16);
383 if ((errno
== ERANGE
&& (var_data_len
== LONG_MAX
))
384 || (errno
!= 0 && var_data_len
== 0))
388 snprintf(path
, PATH_MAX
, "%s/%s-%s/data", SYS_EFI_VAR_PATH
, variable_name
, guid_str(buf
, guid
));
390 dprintf("EFI VAR: path=%s\n", path
);
391 dfd
= open(path
, O_RDONLY
);
395 n
= read(dfd
, buffer
, buf_size
);
397 if (n
!= var_data_len
|| n
< buf_size
) {
404 const struct imsm_orom
*find_imsm_efi(enum sys_dev_type hba_id
)
406 if (hba_id
>= SYS_DEV_MAX
)
409 dprintf("EFI CAP: %p, pid: %d pop: %d\n",
410 &imsm_efi
[hba_id
], (int) getpid(), populated_efi
[hba_id
]);
412 /* it's static data so we only need to read it once */
413 if (populated_efi
[hba_id
]) {
414 dprintf("EFI CAP: %p, pid: %d pop: %d\n",
415 &imsm_efi
[hba_id
], (int) getpid(), populated_efi
[hba_id
]);
416 return &imsm_efi
[hba_id
];
418 if (check_env("IMSM_TEST_AHCI_EFI") ||
419 check_env("IMSM_TEST_SCU_EFI")) {
420 dprintf("OROM CAP: %p, pid: %d pop: %d\n",
421 &imsm_efi
[hba_id
], (int) getpid(), populated_efi
[hba_id
]);
422 return imsm_platform_test(hba_id
, &populated_efi
[hba_id
], &imsm_efi
[hba_id
]);
424 /* OROM test is set, return that there is no EFI capabilities */
425 if (check_env("IMSM_TEST_OROM"))
428 if (read_efi_variable(&imsm_efi
[hba_id
], sizeof(imsm_efi
[0]), hba_id
== SYS_DEV_SAS
? SCU_PROP
: AHCI_PROP
, VENDOR_GUID
)) {
429 populated_efi
[hba_id
] = 0;
433 populated_efi
[hba_id
] = 1;
434 return &imsm_efi
[hba_id
];
438 * backward interface compatibility
440 const struct imsm_orom
*find_imsm_orom(void)
442 return find_imsm_hba_orom(SYS_DEV_SATA
);
445 const struct imsm_orom
*find_imsm_capability(enum sys_dev_type hba_id
)
447 const struct imsm_orom
*cap
=NULL
;
450 if ((cap
= find_imsm_efi(hba_id
)) != NULL
)
452 if ((cap
= find_imsm_hba_orom(hba_id
)) != NULL
)
457 char *devt_to_devpath(dev_t dev
)
461 sprintf(device
, "/sys/dev/block/%d:%d/device", major(dev
), minor(dev
));
462 return canonicalize_file_name(device
);
465 char *diskfd_to_devpath(int fd
)
467 /* return the device path for a disk, return NULL on error or fd
468 * refers to a partition
472 if (fstat(fd
, &st
) != 0)
474 if (!S_ISBLK(st
.st_mode
))
477 return devt_to_devpath(st
.st_rdev
);
480 int path_attached_to_hba(const char *disk_path
, const char *hba_path
)
484 if (check_env("IMSM_TEST_AHCI_DEV") ||
485 check_env("IMSM_TEST_SCU_DEV")) {
489 if (!disk_path
|| !hba_path
)
491 dprintf("hba: %s - disk: %s\n", hba_path
, disk_path
);
492 if (strncmp(disk_path
, hba_path
, strlen(hba_path
)) == 0)
500 int devt_attached_to_hba(dev_t dev
, const char *hba_path
)
502 char *disk_path
= devt_to_devpath(dev
);
503 int rc
= path_attached_to_hba(disk_path
, hba_path
);
511 int disk_attached_to_hba(int fd
, const char *hba_path
)
513 char *disk_path
= diskfd_to_devpath(fd
);
514 int rc
= path_attached_to_hba(disk_path
, hba_path
);