/* (C) 2012 by Harald Welte * * All Rights Reserved * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU Affero General Public License as published by * the Free Software Foundation; either version 3 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU Affero General Public License * along with this program. If not, see . * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "btsconfig.h" #include "sysmobts_misc.h" #include "sysmobts_par.h" #include "sysmobts_mgr.h" /********************************************************************* * Temperature handling *********************************************************************/ #define TEMP_PATH "/sys/class/hwmon/hwmon0/device/temp%u_%s" static const char *temp_type_str[_NUM_TEMP_TYPES] = { [SYSMOBTS_TEMP_INPUT] = "input", [SYSMOBTS_TEMP_LOWEST] = "lowest", [SYSMOBTS_TEMP_HIGHEST] = "highest", }; int sysmobts_temp_get(enum sysmobts_temp_sensor sensor, enum sysmobts_temp_type type) { char buf[PATH_MAX]; char tempstr[8]; int fd, rc; if (sensor < SYSMOBTS_TEMP_DIGITAL || sensor > SYSMOBTS_TEMP_RF) return -EINVAL; if (type >= ARRAY_SIZE(temp_type_str)) return -EINVAL; snprintf(buf, sizeof(buf)-1, TEMP_PATH, sensor, temp_type_str[type]); buf[sizeof(buf)-1] = '\0'; fd = open(buf, O_RDONLY); if (fd < 0) return fd; rc = read(fd, tempstr, sizeof(tempstr)); tempstr[sizeof(tempstr)-1] = '\0'; if (rc < 0) { close(fd); return rc; } if (rc == 0) { close(fd); return -EIO; } close(fd); return atoi(tempstr); } static const struct { const char *name; enum sysmobts_temp_sensor sensor; enum sysmobts_par ee_par; } temp_data[] = { { .name = "digital", .sensor = SYSMOBTS_TEMP_DIGITAL, .ee_par = SYSMOBTS_PAR_TEMP_DIG_MAX, }, { .name = "rf", .sensor = SYSMOBTS_TEMP_RF, .ee_par = SYSMOBTS_PAR_TEMP_RF_MAX, } }; void sysmobts_check_temp(int no_eeprom_write) { int temp_old[ARRAY_SIZE(temp_data)]; int temp_hi[ARRAY_SIZE(temp_data)]; int temp_cur[ARRAY_SIZE(temp_data)]; int i, rc; for (i = 0; i < ARRAY_SIZE(temp_data); i++) { int ret; rc = sysmobts_par_get_int(temp_data[i].ee_par, &ret); temp_old[i] = ret * 1000; temp_hi[i] = sysmobts_temp_get(temp_data[i].sensor, SYSMOBTS_TEMP_HIGHEST); temp_cur[i] = sysmobts_temp_get(temp_data[i].sensor, SYSMOBTS_TEMP_INPUT); if ((temp_cur[i] < 0 && temp_cur[i] > -1000) || (temp_hi[i] < 0 && temp_hi[i] > -1000)) { LOGP(DTEMP, LOGL_ERROR, "Error reading temperature\n"); return; } LOGP(DTEMP, LOGL_DEBUG, "Current %s temperature: %d.%d C\n", temp_data[i].name, temp_cur[i]/1000, temp_cur[i]%1000); if (temp_hi[i] > temp_old[i]) { LOGP(DTEMP, LOGL_NOTICE, "New maximum %s " "temperature: %d.%d C\n", temp_data[i].name, temp_hi[i]/1000, temp_hi[i]%1000); if (!no_eeprom_write) { rc = sysmobts_par_set_int(SYSMOBTS_PAR_TEMP_DIG_MAX, temp_hi[0]/1000); if (rc < 0) LOGP(DTEMP, LOGL_ERROR, "error writing new %s " "max temp %d (%s)\n", temp_data[i].name, rc, strerror(errno)); } } } } /********************************************************************* * Hours handling *********************************************************************/ static time_t last_update; int sysmobts_update_hours(int no_eeprom_write) { time_t now = time(NULL); int rc, op_hrs; /* first time after start of manager program */ if (last_update == 0) { last_update = now; rc = sysmobts_par_get_int(SYSMOBTS_PAR_HOURS, &op_hrs); if (rc < 0) { LOGP(DTEMP, LOGL_ERROR, "Unable to read " "operational hours: %d (%s)\n", rc, strerror(errno)); return rc; } LOGP(DTEMP, LOGL_INFO, "Total hours of Operation: %u\n", op_hrs); return 0; } if (now >= last_update + 3600) { rc = sysmobts_par_get_int(SYSMOBTS_PAR_HOURS, &op_hrs); if (rc < 0) { LOGP(DTEMP, LOGL_ERROR, "Unable to read " "operational hours: %d (%s)\n", rc, strerror(errno)); return rc; } /* number of hours to increase */ op_hrs += (now-last_update)/3600; LOGP(DTEMP, LOGL_INFO, "Total hours of Operation: %u\n", op_hrs); if (!no_eeprom_write) { rc = sysmobts_par_set_int(SYSMOBTS_PAR_HOURS, op_hrs); if (rc < 0) return rc; } last_update = now; } return 0; } /********************************************************************* * Firmware reloading *********************************************************************/ #define SYSMOBTS_FW_PATH "/lib/firmware" static const char *fw_names[_NUM_FW] = { [SYSMOBTS_FW_FPGA] = "sysmobts-v2.bit", [SYSMOBTS_FW_DSP] = "sysmobts-v2.out", }; static const char *fw_devs[_NUM_FW] = { [SYSMOBTS_FW_FPGA] = "/dev/fpgadl_par0", [SYSMOBTS_FW_DSP] = "/dev/dspdl_dm644x_0", }; int sysmobts_firmware_reload(enum sysmobts_firmware_type type) { char name[PATH_MAX]; uint8_t buf[1024]; int fd_in, fd_out, rc; if (type >= _NUM_FW) return -EINVAL; snprintf(name, sizeof(name)-1, "%s/%s", SYSMOBTS_FW_PATH, fw_names[type]); name[sizeof(name)-1] = '\0'; fd_in = open(name, O_RDONLY); if (fd_in < 0) { LOGP(DFW, LOGL_ERROR, "unable ot open firmware file %s: %s\n", name, strerror(errno)); return fd_in; } fd_out = open(fw_devs[type], O_WRONLY); if (fd_out < 0) { LOGP(DFW, LOGL_ERROR, "unable ot open firmware device %s: %s\n", fw_devs[type], strerror(errno)); close(fd_in); return fd_out; } while ((rc = read(fd_in, buf, sizeof(buf)))) { int written; if (rc < 0) { LOGP(DFW, LOGL_ERROR, "error %d during read " "from %s: %s\n", rc, name, strerror(errno)); close(fd_in); close(fd_out); return -EIO; } written = write(fd_out, buf, rc); if (written < rc) { LOGP(DFW, LOGL_ERROR, "short write during " "fw write to %s\n", fw_devs[type]); close(fd_in); close(fd_out); return -EIO; } } close(fd_in); close(fd_out); return 0; }