Blame opae-libs/plugins/xfpga/metrics/bmc/bmc_ioctl.c

Packit 534379
// Copyright(c) 2018-2020, Intel Corporation
Packit 534379
//
Packit 534379
// Redistribution  and  use  in source  and  binary  forms,  with  or  without
Packit 534379
// modification, are permitted provided that the following conditions are met:
Packit 534379
//
Packit 534379
// * Redistributions of  source code  must retain the  above copyright notice,
Packit 534379
//   this list of conditions and the following disclaimer.
Packit 534379
// * Redistributions in binary form must reproduce the above copyright notice,
Packit 534379
//   this list of conditions and the following disclaimer in the documentation
Packit 534379
//   and/or other materials provided with the distribution.
Packit 534379
// * Neither the name  of Intel Corporation  nor the names of its contributors
Packit 534379
//   may be used to  endorse or promote  products derived  from this  software
Packit 534379
//   without specific prior written permission.
Packit 534379
//
Packit 534379
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Packit 534379
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING,  BUT NOT LIMITED TO,  THE
Packit 534379
// IMPLIED WARRANTIES OF  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Packit 534379
// ARE DISCLAIMED.  IN NO EVENT  SHALL THE COPYRIGHT OWNER  OR CONTRIBUTORS BE
Packit 534379
// LIABLE  FOR  ANY  DIRECT,  INDIRECT,  INCIDENTAL,  SPECIAL,  EXEMPLARY,  OR
Packit 534379
// CONSEQUENTIAL  DAMAGES  (INCLUDING,  BUT  NOT LIMITED  TO,  PROCUREMENT  OF
Packit 534379
// SUBSTITUTE GOODS OR SERVICES;  LOSS OF USE,  DATA, OR PROFITS;  OR BUSINESS
Packit 534379
// INTERRUPTION)  HOWEVER CAUSED  AND ON ANY THEORY  OF LIABILITY,  WHETHER IN
Packit 534379
// CONTRACT,  STRICT LIABILITY,  OR TORT  (INCLUDING NEGLIGENCE  OR OTHERWISE)
Packit 534379
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,  EVEN IF ADVISED OF THE
Packit 534379
// POSSIBILITY OF SUCH DAMAGE.
Packit 534379
Packit 534379
#include <opae/fpga.h>
Packit 534379
#include "bmc.h"
Packit 534379
#include "bmcdata.h"
Packit 534379
#include <sys/types.h>
Packit 534379
#include <string.h>
Packit 534379
#ifndef _WIN32
Packit 534379
#include <unistd.h>
Packit 534379
#include <sys/ioctl.h>
Packit 534379
#else
Packit 534379
#include <io.h>
Packit 534379
#endif
Packit 534379
#include <fcntl.h>
Packit 534379
#include <stdlib.h>
Packit 534379
#include "bmc_ioctl.h"
Packit 534379
Packit 534379
#include <glob.h>
Packit 534379
Packit 534379
#define NULL_CHECK(x)                                                          \
Packit 534379
	do {                                                                   \
Packit 534379
		if (NULL == (x)) {                                             \
Packit 534379
			return FPGA_INVALID_PARAM;                             \
Packit 534379
		}                                                              \
Packit 534379
	} while (0)
Packit 534379
Packit 534379
fpga_result rawFromDouble(Values *details, double dbl, uint8_t *raw)
Packit 534379
{
Packit 534379
	fpga_result res = FPGA_OK;
Packit 534379
Packit 534379
	NULL_CHECK(details);
Packit 534379
	NULL_CHECK(raw);
Packit 534379
Packit 534379
	int32_t R_exp = -(details->result_exp);
Packit 534379
	int32_t i;
Packit 534379
	for (i = 0; i < abs(R_exp); i++) {
Packit 534379
		if (R_exp < 0) {
Packit 534379
			dbl /= 10.0;
Packit 534379
		} else {
Packit 534379
			dbl *= 10.0;
Packit 534379
		}
Packit 534379
	}
Packit 534379
Packit 534379
	dbl = (dbl - details->B) / details->M;
Packit 534379
Packit 534379
	*raw = dbl > (double)0xff ? (uint8_t)0xff : (uint8_t)dbl;
Packit 534379
Packit 534379
	return res;
Packit 534379
}
Packit 534379
Packit 534379
void fill_set_request(Values *vals, threshold_list *thresh,
Packit 534379
		     bmc_set_thresh_request *req)
Packit 534379
{
Packit 534379
	fpga_result res = FPGA_OK;
Packit 534379
	uint8_t mask = 0;
Packit 534379
Packit 534379
	if (thresh->upper_nr_thresh.is_valid) {
Packit 534379
		mask |= UNR_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->upper_nr_thresh.value,
Packit 534379
				     &req->UNR);
Packit 534379
	} else {
Packit 534379
		mask &= ~UNR_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (thresh->upper_c_thresh.is_valid) {
Packit 534379
		mask |= UC_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->upper_c_thresh.value,
Packit 534379
				     &req->UC);
Packit 534379
	} else {
Packit 534379
		mask &= ~UC_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (thresh->upper_nc_thresh.is_valid) {
Packit 534379
		mask |= UNC_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->upper_nc_thresh.value,
Packit 534379
				     &req->UNC);
Packit 534379
	} else {
Packit 534379
		mask &= ~UNC_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (thresh->lower_nr_thresh.is_valid) {
Packit 534379
		mask |= LNR_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->lower_nr_thresh.value,
Packit 534379
				     &req->LNR);
Packit 534379
	} else {
Packit 534379
		mask &= ~LNR_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (thresh->lower_c_thresh.is_valid) {
Packit 534379
		mask |= LC_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->lower_c_thresh.value,
Packit 534379
				     &req->LC);
Packit 534379
	} else {
Packit 534379
		mask &= ~LC_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (thresh->lower_nc_thresh.is_valid) {
Packit 534379
		mask |= LNC_thresh;
Packit 534379
		res += rawFromDouble(vals, thresh->lower_nc_thresh.value,
Packit 534379
				     &req->LNC);
Packit 534379
	} else {
Packit 534379
		mask &= ~LNC_thresh;
Packit 534379
	}
Packit 534379
Packit 534379
	if (FPGA_OK == res) {
Packit 534379
		req->mask = mask;
Packit 534379
	}
Packit 534379
}
Packit 534379
Packit 534379
fpga_result _bmcSetThreshold(int fd, uint32_t sensor,
Packit 534379
		    bmc_set_thresh_request *req)
Packit 534379
{
Packit 534379
	bmc_xact xact = {0};
Packit 534379
	bmc_set_thresh_response resp;
Packit 534379
	fpga_result res = FPGA_OK;
Packit 534379
Packit 534379
	xact.argsz = sizeof(xact);
Packit 534379
	xact.txlen = sizeof(bmc_set_thresh_request);
Packit 534379
	xact.rxlen = sizeof(bmc_set_thresh_response);
Packit 534379
	xact.txbuf = (uint64_t)req;
Packit 534379
	xact.rxbuf = (uint64_t)&res;;
Packit 534379
Packit 534379
	req->sens_num = sensor;
Packit 534379
Packit 534379
	req->header[0] = BMC_THRESH_HEADER_0;
Packit 534379
	req->header[1] = BMC_THRESH_HEADER_1;
Packit 534379
	req->header[2] = BMC_SET_THRESH_CMD;
Packit 534379
Packit 534379
	if (ioctl(fd, _IOWR(AVMMI_BMC_MAGIC, 0, struct avmmi_bmc_xact), &xact)
Packit 534379
	    != 0) {
Packit 534379
		res = FPGA_INVALID_PARAM;
Packit 534379
		goto out_close;
Packit 534379
	}
Packit 534379
Packit 534379
	if (resp.cc) {
Packit 534379
		res = FPGA_EXCEPTION;
Packit 534379
	}
Packit 534379
Packit 534379
out_close:
Packit 534379
	return res;
Packit 534379
}
Packit 534379
Packit 534379
fpga_result _bmcGetThreshold(int fd, uint32_t sensor,
Packit 534379
			    bmc_get_thresh_response *resp)
Packit 534379
{
Packit 534379
	bmc_xact xact = {0};
Packit 534379
	bmc_get_thresh_request req;
Packit 534379
	fpga_result res = FPGA_OK;
Packit 534379
Packit 534379
	xact.argsz = sizeof(xact);
Packit 534379
	xact.txlen = sizeof(bmc_get_thresh_request);
Packit 534379
	xact.rxlen = sizeof(bmc_get_thresh_response);
Packit 534379
	xact.txbuf = (uint64_t)&req;
Packit 534379
	xact.rxbuf = (uint64_t)resp;
Packit 534379
Packit 534379
	req.sens_num = sensor;
Packit 534379
Packit 534379
	req.header[0] = BMC_THRESH_HEADER_0;
Packit 534379
	req.header[1] = BMC_THRESH_HEADER_1;
Packit 534379
	req.header[2] = BMC_GET_THRESH_CMD;
Packit 534379
Packit 534379
	if (ioctl(fd, _IOWR(AVMMI_BMC_MAGIC, 0, struct avmmi_bmc_xact), &xact)
Packit 534379
	    != 0) {
Packit 534379
		res = FPGA_INVALID_PARAM;
Packit 534379
		goto out_close;
Packit 534379
	}
Packit 534379
Packit 534379
	if (resp->cc) {
Packit 534379
		res = FPGA_EXCEPTION;
Packit 534379
	}
Packit 534379
Packit 534379
out_close:
Packit 534379
	return res;
Packit 534379
}
Packit 534379
Packit 534379
fpga_result bmcSetHWThresholds(bmc_sdr_handle sdr_h, uint32_t sensor,
Packit 534379
			       threshold_list *thresh)
Packit 534379
{
Packit 534379
	fpga_result res = FPGA_OK;
Packit 534379
	char sysfspath[SYSFS_PATH_MAX] = { 0, };
Packit 534379
	int fd = 0;
Packit 534379
	bmc_set_thresh_request req;
Packit 534379
	Values *vals;
Packit 534379
	sensor_reading read;
Packit 534379
	bmc_get_thresh_response resp;
Packit 534379
	size_t len;
Packit 534379
Packit 534379
	NULL_CHECK(sdr_h);
Packit 534379
	NULL_CHECK(thresh);
Packit 534379
	struct _sdr_rec *sdr = (struct _sdr_rec *)sdr_h;
Packit 534379
Packit 534379
	if (BMC_SDR_MAGIC != sdr->magic) {
Packit 534379
		return FPGA_INVALID_PARAM;
Packit 534379
	}
Packit 534379
Packit 534379
	if (sensor >= sdr->num_records) {
Packit 534379
		return FPGA_INVALID_PARAM;
Packit 534379
	}
Packit 534379
Packit 534379
	if (snprintf(sysfspath, sizeof(sysfspath),
Packit 534379
		     "%s/" SYSFS_AVMMI_DIR, sdr->sysfs_path) < 0) {
Packit 534379
		OPAE_ERR("snprintf buffer overflow");
Packit 534379
		return FPGA_EXCEPTION;
Packit 534379
	}
Packit 534379
Packit 534379
	glob_t pglob;
Packit 534379
	int gres = glob(sysfspath, GLOB_NOSORT, NULL, &pglob);
Packit 534379
	if ((gres) || (1 != pglob.gl_pathc)) {
Packit 534379
		globfree(&pglob);
Packit 534379
		return FPGA_NOT_FOUND;
Packit 534379
	}
Packit 534379
Packit 534379
	char *avmmi = strrchr(pglob.gl_pathv[0], '/');
Packit 534379
	if (NULL == avmmi) {
Packit 534379
		globfree(&pglob);
Packit 534379
		return FPGA_NOT_FOUND;
Packit 534379
	}
Packit 534379
Packit 534379
	strncpy(sysfspath, "/dev/", 6);
Packit 534379
	len = strnlen(&avmmi[1], sizeof(sysfspath) - 6);
Packit 534379
	strncat(sysfspath, &avmmi[1], len + 1);
Packit 534379
Packit 534379
	fd = open(sysfspath, O_RDWR);
Packit 534379
	globfree(&pglob);
Packit 534379
	if (fd < 0) {
Packit 534379
		return FPGA_NOT_FOUND;
Packit 534379
	}
Packit 534379
Packit 534379
	memset(&req, 0, sizeof(req));
Packit 534379
	memset(&read, 0, sizeof(read));
Packit 534379
Packit 534379
	vals = bmc_build_values(&read, &sdr->contents[sensor].header,
Packit 534379
				&sdr->contents[sensor].key,
Packit 534379
				&sdr->contents[sensor].body);
Packit 534379
Packit 534379
	if (NULL == vals) {
Packit 534379
		close(fd);
Packit 534379
		return FPGA_NO_MEMORY;
Packit 534379
	}
Packit 534379
Packit 534379
	res = _bmcGetThreshold(fd, sensor, &resp);
Packit 534379
	if (FPGA_OK != res) {
Packit 534379
		fprintf(stderr, "Error returned from _bmcGetThreshold\n");
Packit 534379
	}
Packit 534379
Packit 534379
	lseek(fd, 0, SEEK_SET);
Packit 534379
Packit 534379
	req.mask = resp.mask;
Packit 534379
	req.LNC = resp.LNC;
Packit 534379
	req.LC = resp.LC;
Packit 534379
	req.LNR = resp.LNR;
Packit 534379
	req.UNC = resp.UNC;
Packit 534379
	req.UC = resp.UC;
Packit 534379
	req.UNR = resp.UNR;
Packit 534379
Packit 534379
	fill_set_request(vals, thresh, &req;;
Packit 534379
Packit 534379
	if (vals->name)
Packit 534379
		free(vals->name);
Packit 534379
Packit 534379
	if (vals)
Packit 534379
		free(vals);
Packit 534379
Packit 534379
	res = _bmcSetThreshold(fd, sensor, &req;;
Packit 534379
Packit 534379
	close(fd);
Packit 534379
Packit 534379
	return res;
Packit 534379
}