Blame src/cntrl.c

Packit Service db8df9
/*
Packit Service db8df9
 * Intel(R) Enclosure LED Utilities
Packit Service db8df9
 * Copyright (C) 2009-2020 Intel Corporation.
Packit Service db8df9
 *
Packit Service db8df9
 * This program is free software; you can redistribute it and/or modify it
Packit Service db8df9
 * under the terms and conditions of the GNU General Public License,
Packit Service db8df9
 * version 2, as published by the Free Software Foundation.
Packit Service db8df9
 *
Packit Service db8df9
 * This program is distributed in the hope it will be useful, but WITHOUT
Packit Service db8df9
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
Packit Service db8df9
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
Packit Service db8df9
 * more details.
Packit Service db8df9
 *
Packit Service db8df9
 * You should have received a copy of the GNU General Public License along with
Packit Service db8df9
 * this program; if not, write to the Free Software Foundation, Inc.,
Packit Service db8df9
 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
Packit Service db8df9
 *
Packit Service db8df9
 */
Packit Service db8df9
Packit Service db8df9
#include <dirent.h>
Packit Service db8df9
#include <limits.h>
Packit Service db8df9
#include <stdint.h>
Packit Service db8df9
#include <stdio.h>
Packit Service db8df9
#include <stdlib.h>
Packit Service db8df9
#include <string.h>
Packit Service db8df9
Packit Service db8df9
#if _HAVE_DMALLOC_H
Packit Service db8df9
#include <dmalloc.h>
Packit Service db8df9
#endif
Packit Service db8df9
Packit Service db8df9
#include "cntrl.h"
Packit Service db8df9
#include "config.h"
Packit Service db8df9
#include "config_file.h"
Packit Service db8df9
#include "list.h"
Packit Service db8df9
#include "smp.h"
Packit Service db8df9
#include "status.h"
Packit Service db8df9
#include "sysfs.h"
Packit Service db8df9
#include "utils.h"
Packit Service db8df9
#include "amd.h"
Packit Service db8df9
#include "npem.h"
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 * @brief Name of controllers types.
Packit Service db8df9
 *
Packit Service db8df9
 * This is internal array with names of controller types. Array can be use to
Packit Service db8df9
 * translate enumeration type into the string.
Packit Service db8df9
 */
Packit Service db8df9
static const char * const ctrl_type_str[] = {
Packit Service db8df9
	[CNTRL_TYPE_UNKNOWN] = "?",
Packit Service db8df9
	[CNTRL_TYPE_DELLSSD] = "Dell SSD",
Packit Service db8df9
	[CNTRL_TYPE_VMD]     = "VMD",
Packit Service db8df9
	[CNTRL_TYPE_SCSI]    = "SCSI",
Packit Service db8df9
	[CNTRL_TYPE_AHCI]    = "AHCI",
Packit Service db8df9
	[CNTRL_TYPE_NPEM]    = "NPEM",
Packit Service db8df9
	[CNTRL_TYPE_AMD]     = "AMD",
Packit Service db8df9
};
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 */
Packit Service db8df9
static int _is_storage_controller(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	uint64_t class = get_uint64(path, 0, "class");
Packit Service db8df9
	return (class & 0xff0000L) == 0x010000L;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 */
Packit Service db8df9
static int _is_isci_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	return sysfs_check_driver(path, "isci");
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 */
Packit Service db8df9
static int _is_cntrl(const char *path, const char *type)
Packit Service db8df9
{
Packit Service db8df9
	char temp[PATH_MAX], link[PATH_MAX], *t;
Packit Service db8df9
Packit Service db8df9
	snprintf(temp, sizeof(temp), "%s/driver", path);
Packit Service db8df9
Packit Service db8df9
	if (realpath(temp, link) == NULL)
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	t = strrchr(link, '/');
Packit Service db8df9
	if ((t != NULL) && (strcmp(t + 1, type) != 0))
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	return 1;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_ahci_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	return _is_cntrl(path, "ahci");
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_nvme_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	return _is_cntrl(path, "nvme");
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_intel_ahci_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	if (!_is_ahci_cntrl(path))
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	return get_uint64(path, 0, "vendor") == 0x8086L;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_amd_ahci_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	if (!_is_ahci_cntrl(path))
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	return get_uint64(path, 0, "vendor") == 0x1022L;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_amd_nvme_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	char tmp[PATH_MAX];
Packit Service db8df9
	char *t;
Packit Service db8df9
Packit Service db8df9
	if (!_is_nvme_cntrl(path))
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	sprintf(tmp, "%s", path);
Packit Service db8df9
	t = strrchr(tmp, '/');
Packit Service db8df9
	if (!t)
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	t++;
Packit Service db8df9
	*t = '\0';
Packit Service db8df9
	return get_uint64(tmp, 0, "vendor") == 0x1022L;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_amd_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	if (_is_amd_ahci_cntrl(path))
Packit Service db8df9
		return 1;
Packit Service db8df9
Packit Service db8df9
	if (_is_amd_nvme_cntrl(path))
Packit Service db8df9
		return 1;
Packit Service db8df9
Packit Service db8df9
	return 0;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
extern int get_dell_server_type(void);
Packit Service db8df9
Packit Service db8df9
static int _is_dellssd_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	uint64_t vdr, dev, svdr, cls;
Packit Service db8df9
	int gen = 0;
Packit Service db8df9
Packit Service db8df9
	vdr = get_uint64(path, 0, "vendor");
Packit Service db8df9
	dev = get_uint64(path, 0, "device");
Packit Service db8df9
	cls = get_uint64(path, 0, "class");
Packit Service db8df9
	svdr = get_uint64(path, 0, "subsystem_vendor");
Packit Service db8df9
	if (cls == 0x10802)
Packit Service db8df9
		gen = get_dell_server_type();
Packit Service db8df9
Packit Service db8df9
	return ((vdr == 0x1344L && dev == 0x5150L) || /* micron ssd */
Packit Service db8df9
		(gen != 0) ||			      /* Dell Server+NVME */
Packit Service db8df9
	        (svdr == 0x1028 && cls == 0x10802));  /* nvmhci ssd */
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 */
Packit Service db8df9
static int _is_smp_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	int result = 0;
Packit Service db8df9
	struct list dir;
Packit Service db8df9
	char *p;
Packit Service db8df9
	char host_path[PATH_MAX] = { 0 };
Packit Service db8df9
	if (scan_dir(path, &dir) == 0) {
Packit Service db8df9
		const char *dir_path;
Packit Service db8df9
Packit Service db8df9
		list_for_each(&dir, dir_path) {
Packit Service db8df9
			p = strrchr(dir_path, '/');
Packit Service db8df9
			if (!p++)
Packit Service db8df9
				break;
Packit Service db8df9
			if (strncmp(p, "host", strlen("host")) == 0) {
Packit Service db8df9
				snprintf(host_path, sizeof(host_path),
Packit Service db8df9
					"%s/%s/bsg/sas_%s", path, p, p);
Packit Service db8df9
				result = smp_write_gpio(host_path,
Packit Service db8df9
					GPIO_REG_TYPE_TX,
Packit Service db8df9
					0,
Packit Service db8df9
					0,
Packit Service db8df9
					"",
Packit Service db8df9
					0) == 0;
Packit Service db8df9
			}
Packit Service db8df9
		}
Packit Service db8df9
		list_erase(&dir;;
Packit Service db8df9
	}
Packit Service db8df9
Packit Service db8df9
	return result;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_vmd_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	return sysfs_check_driver(path, "vmd");
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
static int _is_npem_cntrl(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	return is_npem_capable(path);
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 * @brief Determines the type of controller.
Packit Service db8df9
 *
Packit Service db8df9
 * This is internal function of 'controller device' module. The function
Packit Service db8df9
 * determines the type of controller device. It might be AHCI, SCSI or
Packit Service db8df9
 * UNKNOWN device type.
Packit Service db8df9
 *
Packit Service db8df9
 * @param[in]      path           path to controller device in sysfs tree.
Packit Service db8df9
 *
Packit Service db8df9
 * @return The type of controller device. If the type returned is
Packit Service db8df9
 *         CNTRL_TYPE_UNKNOWN this means a controller device is not
Packit Service db8df9
 *         supported.
Packit Service db8df9
 */
Packit Service db8df9
static enum cntrl_type _get_type(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	enum cntrl_type type = CNTRL_TYPE_UNKNOWN;
Packit Service db8df9
	if (_is_npem_cntrl(path)) {
Packit Service db8df9
		type = CNTRL_TYPE_NPEM;
Packit Service db8df9
	} else if (_is_vmd_cntrl(path)) {
Packit Service db8df9
		type = CNTRL_TYPE_VMD;
Packit Service db8df9
	} else if (_is_dellssd_cntrl(path)) {
Packit Service db8df9
		type = CNTRL_TYPE_DELLSSD;
Packit Service db8df9
	} else if (_is_storage_controller(path)) {
Packit Service db8df9
		if (_is_intel_ahci_cntrl(path))
Packit Service db8df9
			type = CNTRL_TYPE_AHCI;
Packit Service db8df9
		else if (_is_amd_cntrl(path))
Packit Service db8df9
			type = CNTRL_TYPE_AMD;
Packit Service db8df9
		else if (_is_isci_cntrl(path)
Packit Service db8df9
				|| sysfs_enclosure_attached_to_cntrl(path)
Packit Service db8df9
				|| _is_smp_cntrl(path))
Packit Service db8df9
			type = CNTRL_TYPE_SCSI;
Packit Service db8df9
	}
Packit Service db8df9
	return type;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
struct _host_type *alloc_host(int id, struct _host_type *next)
Packit Service db8df9
{
Packit Service db8df9
	struct _host_type *host = NULL;
Packit Service db8df9
	host = malloc(sizeof(struct _host_type));
Packit Service db8df9
	if (host) {
Packit Service db8df9
		host->host_id = id;
Packit Service db8df9
		host->ibpi_state_buffer = NULL;
Packit Service db8df9
		memset(host->bitstream, 0, sizeof(host->bitstream));
Packit Service db8df9
		host->flush = 0;
Packit Service db8df9
		host->ports = 0;
Packit Service db8df9
		host->next = next;
Packit Service db8df9
	}
Packit Service db8df9
	return host;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
void free_hosts(struct _host_type *h)
Packit Service db8df9
{
Packit Service db8df9
	struct _host_type *t;
Packit Service db8df9
	while (h) {
Packit Service db8df9
		t = h->next;
Packit Service db8df9
		free(h->ibpi_state_buffer);
Packit Service db8df9
		free(h);
Packit Service db8df9
		h = t;
Packit Service db8df9
	}
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
void _find_host(const char *path, struct _host_type **hosts)
Packit Service db8df9
{
Packit Service db8df9
	const int host_len = sizeof("host") - 1;
Packit Service db8df9
	char *p;
Packit Service db8df9
	int index = -1;
Packit Service db8df9
	struct _host_type *th;
Packit Service db8df9
	DIR *d;
Packit Service db8df9
	struct dirent *de;
Packit Service db8df9
Packit Service db8df9
	p = strrchr(path, '/');
Packit Service db8df9
	if (!p++)
Packit Service db8df9
		return;
Packit Service db8df9
	if (strncmp(p, "host", host_len - 1) == 0) {
Packit Service db8df9
		index = atoi(p + host_len);
Packit Service db8df9
		th = alloc_host(index, (*hosts) ? (*hosts) : NULL);
Packit Service db8df9
		if (!th)
Packit Service db8df9
			return;
Packit Service db8df9
Packit Service db8df9
		d = opendir(path);
Packit Service db8df9
		if(!d) {
Packit Service db8df9
			free(th);
Packit Service db8df9
			return;
Packit Service db8df9
		}
Packit Service db8df9
Packit Service db8df9
		while ((de = readdir(d))) {
Packit Service db8df9
			if (strncmp(de->d_name, "phy-", strlen("phy-")) == 0) {
Packit Service db8df9
				th->ports++;
Packit Service db8df9
			}
Packit Service db8df9
		}
Packit Service db8df9
Packit Service db8df9
		closedir(d);
Packit Service db8df9
Packit Service db8df9
		*hosts = th;
Packit Service db8df9
	}
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 * @brief Get all instances of separate hosts on isci controller.
Packit Service db8df9
 *
Packit Service db8df9
 */
Packit Service db8df9
static struct _host_type *_cntrl_get_hosts(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	struct _host_type *hosts = NULL;
Packit Service db8df9
	struct list dir;
Packit Service db8df9
	if (scan_dir(path, &dir) == 0) {
Packit Service db8df9
		const char *dir_path;
Packit Service db8df9
Packit Service db8df9
		list_for_each(&dir, dir_path)
Packit Service db8df9
			_find_host(dir_path, &hosts);
Packit Service db8df9
		list_erase(&dir;;
Packit Service db8df9
	}
Packit Service db8df9
	return hosts;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/**
Packit Service db8df9
 * @brief Check if enclosure management is enabled.
Packit Service db8df9
 *
Packit Service db8df9
 * This is internal function of 'controller device' module. The function checks
Packit Service db8df9
 * whether enclosure management is enabled for AHCI controller.
Packit Service db8df9
 *
Packit Service db8df9
 * @param[in]      path           path to controller device in sysfs tree.
Packit Service db8df9
 *
Packit Service db8df9
 * @return 1 if enclosure management is enabled, otherwise the function returns 0.
Packit Service db8df9
 */
Packit Service db8df9
static unsigned int _ahci_em_messages(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	/* first, open ...driver/module/parameters/ahci_em_messages
Packit Service db8df9
	 * then open /sys/module/libahci/parameters/ahci_em_messages
Packit Service db8df9
	 * and check if it is set to enabled.
Packit Service db8df9
	 * if so, check if 'holders' of libahci points the same driver name
Packit Service db8df9
	 * as device given by path
Packit Service db8df9
	 */
Packit Service db8df9
	char buf[PATH_MAX];
Packit Service db8df9
	char *link, *name;
Packit Service db8df9
	DIR *dh;
Packit Service db8df9
	struct dirent *de = NULL;
Packit Service db8df9
Packit Service db8df9
	/* old kernel (prior to 2.6.36) */
Packit Service db8df9
	if (get_int(path, 0, "driver/module/parameters/ahci_em_messages") != 0)
Packit Service db8df9
		return 1;
Packit Service db8df9
Packit Service db8df9
	/* parameter type changed from int to bool since kernel v3.13 */
Packit Service db8df9
	if (!get_int("", 0, "sys/module/libahci/parameters/ahci_em_messages")) {
Packit Service db8df9
		if (!get_bool("", 0, "sys/module/libahci/parameters/ahci_em_messages"))
Packit Service db8df9
			return 0;
Packit Service db8df9
	}
Packit Service db8df9
Packit Service db8df9
	if (snprintf(buf, sizeof(buf), "%s/%s", path, "driver") < 0)
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	link = realpath(buf, NULL);
Packit Service db8df9
	if (!link)
Packit Service db8df9
		return 0;
Packit Service db8df9
Packit Service db8df9
	name = strrchr(link, '/');
Packit Service db8df9
	if (!name++) {
Packit Service db8df9
		free(link);
Packit Service db8df9
		return 0;
Packit Service db8df9
	}
Packit Service db8df9
Packit Service db8df9
	/* check if the directory /sys/module/libahci/holders exists */
Packit Service db8df9
	dh = opendir("/sys/module/libahci/holders");
Packit Service db8df9
	if (dh) {
Packit Service db8df9
		/* name contain controller name (ie. ahci),*/
Packit Service db8df9
		/* so check if libahci holds this driver   */
Packit Service db8df9
		while ((de = readdir(dh))) {
Packit Service db8df9
			if (!strcmp(de->d_name, name))
Packit Service db8df9
				break;
Packit Service db8df9
		}
Packit Service db8df9
		closedir(dh);
Packit Service db8df9
		free(link);
Packit Service db8df9
		return de ? 1 : 0;
Packit Service db8df9
	} else {
Packit Service db8df9
		free(link);
Packit Service db8df9
		return 1;
Packit Service db8df9
	}
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/*
Packit Service db8df9
 * Allocates memory for a new controller device structure. See cntrl.h for
Packit Service db8df9
 * details.
Packit Service db8df9
 */
Packit Service db8df9
struct cntrl_device *cntrl_device_init(const char *path)
Packit Service db8df9
{
Packit Service db8df9
	unsigned int em_enabled;
Packit Service db8df9
	enum cntrl_type type;
Packit Service db8df9
	struct cntrl_device *device = NULL;
Packit Service db8df9
Packit Service db8df9
	type = _get_type(path);
Packit Service db8df9
	if (type != CNTRL_TYPE_UNKNOWN) {
Packit Service db8df9
		switch (type) {
Packit Service db8df9
		case CNTRL_TYPE_DELLSSD:
Packit Service db8df9
		case CNTRL_TYPE_SCSI:
Packit Service db8df9
		case CNTRL_TYPE_VMD:
Packit Service db8df9
		case CNTRL_TYPE_NPEM:
Packit Service db8df9
			em_enabled = 1;
Packit Service db8df9
			break;
Packit Service db8df9
		case CNTRL_TYPE_AHCI:
Packit Service db8df9
			em_enabled = _ahci_em_messages(path);
Packit Service db8df9
			break;
Packit Service db8df9
		case CNTRL_TYPE_AMD:
Packit Service db8df9
			em_enabled = amd_em_enabled(path);
Packit Service db8df9
			break;
Packit Service db8df9
		default:
Packit Service db8df9
			em_enabled = 0;
Packit Service db8df9
		}
Packit Service db8df9
		if (em_enabled) {
Packit Service db8df9
			if (!list_is_empty(&conf.cntrls_whitelist)) {
Packit Service db8df9
				char *cntrl = NULL;
Packit Service db8df9
Packit Service db8df9
				list_for_each(&conf.cntrls_whitelist, cntrl) {
Packit Service db8df9
					if (match_string(cntrl, path))
Packit Service db8df9
						break;
Packit Service db8df9
					cntrl = NULL;
Packit Service db8df9
				}
Packit Service db8df9
				if (!cntrl) {
Packit Service db8df9
					log_debug("%s not found on whitelist, ignoring", path);
Packit Service db8df9
					return NULL;
Packit Service db8df9
				}
Packit Service db8df9
			} else if (!list_is_empty(&conf.cntrls_blacklist)) {
Packit Service db8df9
				char *cntrl;
Packit Service db8df9
Packit Service db8df9
				list_for_each(&conf.cntrls_blacklist, cntrl) {
Packit Service db8df9
					if (match_string(cntrl, path)) {
Packit Service db8df9
						log_debug("%s found on blacklist, ignoring",
Packit Service db8df9
							  path);
Packit Service db8df9
						return NULL;
Packit Service db8df9
					}
Packit Service db8df9
				}
Packit Service db8df9
			}
Packit Service db8df9
			device = malloc(sizeof(struct cntrl_device));
Packit Service db8df9
			if (device) {
Packit Service db8df9
				if (type == CNTRL_TYPE_SCSI) {
Packit Service db8df9
					device->isci_present = _is_isci_cntrl(path);
Packit Service db8df9
					device->hosts = _cntrl_get_hosts(path);
Packit Service db8df9
				} else {
Packit Service db8df9
					device->isci_present = 0;
Packit Service db8df9
					device->hosts = NULL;
Packit Service db8df9
				}
Packit Service db8df9
				device->cntrl_type = type;
Packit Service db8df9
				device->sysfs_path = str_dup(path);
Packit Service db8df9
			}
Packit Service db8df9
		} else {
Packit Service db8df9
			log_error
Packit Service db8df9
			    ("controller discovery: %s - enclosure " \
Packit Service db8df9
			     "management not supported.", path);
Packit Service db8df9
		}
Packit Service db8df9
	}
Packit Service db8df9
	return device;
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
/*
Packit Service db8df9
 * Frees memory allocated for controller device structure. See cntrl.h for
Packit Service db8df9
 * details.
Packit Service db8df9
 */
Packit Service db8df9
void cntrl_device_fini(struct cntrl_device *device)
Packit Service db8df9
{
Packit Service db8df9
	if (device) {
Packit Service db8df9
		free(device->sysfs_path);
Packit Service db8df9
		free_hosts(device->hosts);
Packit Service db8df9
		free(device);
Packit Service db8df9
	}
Packit Service db8df9
}
Packit Service db8df9
Packit Service db8df9
void print_cntrl(struct cntrl_device *ctrl_dev)
Packit Service db8df9
{
Packit Service db8df9
		printf("%s (%s)\n", ctrl_dev->sysfs_path,
Packit Service db8df9
			ctrl_type_str[ctrl_dev->cntrl_type]);
Packit Service db8df9
}