#include <sys/cdefs.h>
#include "opt_acpi.h"
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/bus.h>
#include <sys/ioccom.h>
#include <sys/sysctl.h>
#include <contrib/dev/acpica/include/acpi.h>
#include <dev/acpica/acpivar.h>
#include <dev/acpica/acpiio.h>
#define ACPI_BATTERY_INFO_EXPIRE 5
static int acpi_batteries_initialized;
static int acpi_battery_info_expire = ACPI_BATTERY_INFO_EXPIRE;
static struct acpi_battinfo acpi_battery_battinfo;
static struct sysctl_ctx_list acpi_battery_sysctl_ctx;
static struct sysctl_oid *acpi_battery_sysctl_tree;
ACPI_SERIAL_DECL(battery, "ACPI generic battery");
static void acpi_reset_battinfo(struct acpi_battinfo *info);
static void acpi_battery_clean_str(char *str, int len);
static device_t acpi_battery_find_dev(u_int logical_unit);
static int acpi_battery_ioctl(u_long cmd, caddr_t addr, void *arg);
static int acpi_battery_sysctl(SYSCTL_HANDLER_ARGS);
static int acpi_battery_units_sysctl(SYSCTL_HANDLER_ARGS);
static int acpi_battery_init(void);
int
acpi_battery_register(device_t dev)
{
int error;
ACPI_SERIAL_BEGIN(battery);
error = acpi_battery_init();
ACPI_SERIAL_END(battery);
return (error);
}
int
acpi_battery_remove(device_t dev)
{
return (0);
}
int
acpi_battery_get_units(void)
{
devclass_t batt_dc;
batt_dc = devclass_find("battery");
if (batt_dc == NULL)
return (0);
return (devclass_get_count(batt_dc));
}
int
acpi_battery_get_info_expire(void)
{
return (acpi_battery_info_expire);
}
int
acpi_battery_bst_valid(struct acpi_bst *bst)
{
return (bst->state != ACPI_BATT_STAT_NOT_PRESENT &&
bst->cap != ACPI_BATT_UNKNOWN && bst->volt != ACPI_BATT_UNKNOWN);
}
int
acpi_battery_bix_valid(struct acpi_bix *bix)
{
return (bix->lfcap != 0);
}
int
acpi_battery_get_battinfo(device_t dev, struct acpi_battinfo *battinfo)
{
int batt_stat, devcount, dev_idx, error, i;
int total_cap, total_lfcap, total_min, valid_rate, valid_units;
devclass_t batt_dc;
device_t batt_dev;
struct acpi_bst *bst;
struct acpi_bix *bix;
struct acpi_battinfo *bi;
batt_dc = devclass_find("battery");
if (batt_dc == NULL)
return (ENXIO);
devcount = devclass_get_maxunit(batt_dc);
if (devcount == 0)
return (ENXIO);
bst = malloc(devcount * sizeof(*bst), M_TEMP, M_WAITOK | M_ZERO);
bi = malloc(devcount * sizeof(*bi), M_TEMP, M_WAITOK | M_ZERO);
bix = malloc(sizeof(*bix), M_TEMP, M_WAITOK | M_ZERO);
dev_idx = -1;
batt_stat = valid_rate = valid_units = 0;
total_cap = total_lfcap = 0;
for (i = 0; i < devcount; i++) {
acpi_reset_battinfo(&bi[i]);
batt_dev = devclass_get_device(batt_dc, i);
if (batt_dev == NULL)
continue;
if (dev != NULL && dev == batt_dev)
dev_idx = i;
if (ACPI_BATT_GET_STATUS(batt_dev, &bst[i]) != 0 ||
ACPI_BATT_GET_INFO(batt_dev, bix, sizeof(*bix)) != 0)
continue;
if (!acpi_battery_bst_valid(&bst[i]) ||
!acpi_battery_bix_valid(bix))
continue;
valid_units++;
if ((bst[i].state & ACPI_BATT_STAT_DISCHARG) != 0)
bst[i].state &= ~ACPI_BATT_STAT_CHARGING;
batt_stat |= bst[i].state;
bi[i].state = bst[i].state;
if (bix->units == ACPI_BIX_UNITS_MA && bix->dvol != 0 && dev == NULL) {
bst[i].rate = (bst[i].rate * bix->dvol) / 1000;
bst[i].cap = (bst[i].cap * bix->dvol) / 1000;
bix->lfcap = (bix->lfcap * bix->dvol) / 1000;
}
if (!acpi_battery_bix_valid(bix))
continue;
if (bst[i].cap > bix->lfcap)
bst[i].cap = bix->lfcap;
bi[i].cap = (100 * bst[i].cap) / bix->lfcap;
if (bi[i].cap != -1) {
total_cap += bst[i].cap;
total_lfcap += bix->lfcap;
}
if (bst[i].rate != ACPI_BATT_UNKNOWN &&
(bst[i].state & ACPI_BATT_STAT_DISCHARG) != 0)
valid_rate += bst[i].rate;
}
if (dev != NULL && dev_idx == -1) {
error = ENXIO;
goto out;
}
total_min = 0;
for (i = 0; i < devcount; i++) {
if (valid_rate > 0)
bi[i].min = (60 * bst[i].cap) / valid_rate;
else
bi[i].min = 0;
total_min += bi[i].min;
}
if (valid_units > 0) {
if (dev == NULL) {
if (total_lfcap > 0)
battinfo->cap = (total_cap * 100) / total_lfcap;
else
battinfo->cap = 0;
battinfo->min = total_min;
battinfo->state = batt_stat;
battinfo->rate = valid_rate;
} else {
battinfo->cap = bi[dev_idx].cap;
battinfo->min = bi[dev_idx].min;
battinfo->state = bi[dev_idx].state;
battinfo->rate = bst[dev_idx].rate;
}
if (valid_rate == 0 || (battinfo->state & ACPI_BATT_STAT_CHARGING))
battinfo->min = -1;
} else
acpi_reset_battinfo(battinfo);
error = 0;
out:
free(bi, M_TEMP);
free(bix, M_TEMP);
free(bst, M_TEMP);
return (error);
}
static void
acpi_reset_battinfo(struct acpi_battinfo *info)
{
info->cap = -1;
info->min = -1;
info->state = ACPI_BATT_STAT_NOT_PRESENT;
info->rate = -1;
}
static void
acpi_battery_clean_str(char *str, int len)
{
int i;
for (i = 0; i < len && *str != '\0'; i++, str++) {
if (!isprint(*str))
*str = '?';
}
if (i == len)
*str = '\0';
}
static device_t
acpi_battery_find_dev(u_int logical_unit)
{
int found_unit, i, maxunit;
device_t dev;
devclass_t batt_dc;
dev = NULL;
found_unit = 0;
batt_dc = devclass_find("battery");
maxunit = devclass_get_maxunit(batt_dc);
for (i = 0; i < maxunit; i++) {
dev = devclass_get_device(batt_dc, i);
if (dev == NULL)
continue;
if (logical_unit == found_unit)
break;
found_unit++;
dev = NULL;
}
return (dev);
}
static int
acpi_battery_ioctl(u_long cmd, caddr_t addr, void *arg)
{
union acpi_battery_ioctl_arg *ioctl_arg;
int error, unit;
device_t dev;
error = ENXIO;
unit = 0;
dev = NULL;
ioctl_arg = NULL;
if (IOCPARM_LEN(cmd) == sizeof(union acpi_battery_ioctl_arg) ||
IOCPARM_LEN(cmd) == sizeof(union acpi_battery_ioctl_arg_v1)) {
ioctl_arg = (union acpi_battery_ioctl_arg *)addr;
unit = ioctl_arg->unit;
if (unit != ACPI_BATTERY_ALL_UNITS)
dev = acpi_battery_find_dev(unit);
}
switch (cmd) {
case ACPIIO_BATT_GET_UNITS:
*(int *)addr = acpi_battery_get_units();
error = 0;
break;
case ACPIIO_BATT_GET_BATTINFO:
case ACPIIO_BATT_GET_BATTINFO_V1:
if (dev != NULL || unit == ACPI_BATTERY_ALL_UNITS) {
bzero(&ioctl_arg->battinfo, sizeof(ioctl_arg->battinfo));
error = acpi_battery_get_battinfo(dev, &ioctl_arg->battinfo);
}
break;
case ACPIIO_BATT_GET_BIF:
if (dev != NULL) {
bzero(&ioctl_arg->bif, sizeof(ioctl_arg->bif));
error = ACPI_BATT_GET_INFO(dev, &ioctl_arg->bif,
sizeof(ioctl_arg->bif));
}
break;
case ACPIIO_BATT_GET_BIX:
if (dev != NULL) {
bzero(&ioctl_arg->bix, sizeof(ioctl_arg->bix));
error = ACPI_BATT_GET_INFO(dev, &ioctl_arg->bix,
sizeof(ioctl_arg->bix));
}
break;
case ACPIIO_BATT_GET_BST:
case ACPIIO_BATT_GET_BST_V1:
if (dev != NULL) {
bzero(&ioctl_arg->bst, sizeof(ioctl_arg->bst));
error = ACPI_BATT_GET_STATUS(dev, &ioctl_arg->bst);
}
break;
default:
error = EINVAL;
}
switch (cmd) {
case ACPIIO_BATT_GET_BIX:
case ACPIIO_BATT_GET_BIF:
acpi_battery_clean_str(ioctl_arg->bix.model,
sizeof(ioctl_arg->bix.model));
acpi_battery_clean_str(ioctl_arg->bix.serial,
sizeof(ioctl_arg->bix.serial));
acpi_battery_clean_str(ioctl_arg->bix.type,
sizeof(ioctl_arg->bix.type));
acpi_battery_clean_str(ioctl_arg->bix.oeminfo,
sizeof(ioctl_arg->bix.oeminfo));
};
return (error);
}
static int
acpi_battery_sysctl(SYSCTL_HANDLER_ARGS)
{
int val, error;
acpi_battery_get_battinfo(NULL, &acpi_battery_battinfo);
val = *(u_int *)oidp->oid_arg1;
error = sysctl_handle_int(oidp, &val, 0, req);
return (error);
}
static int
acpi_battery_units_sysctl(SYSCTL_HANDLER_ARGS)
{
int count, error;
count = acpi_battery_get_units();
error = sysctl_handle_int(oidp, &count, 0, req);
return (error);
}
static int
acpi_battery_init(void)
{
struct acpi_softc *sc;
device_t dev;
int error;
ACPI_SERIAL_ASSERT(battery);
if (acpi_batteries_initialized)
return(0);
error = ENXIO;
dev = devclass_get_device(devclass_find("acpi"), 0);
if (dev == NULL)
goto out;
sc = device_get_softc(dev);
#define ACPI_REGISTER_IOCTL(a, b, c) do { \
error = acpi_register_ioctl(a, b, c); \
if (error) \
goto out; \
} while (0)
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_UNITS, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BATTINFO, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BATTINFO_V1, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BIF, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BIX, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BST, acpi_battery_ioctl, NULL);
ACPI_REGISTER_IOCTL(ACPIIO_BATT_GET_BST_V1, acpi_battery_ioctl, NULL);
#undef ACPI_REGISTER_IOCTL
sysctl_ctx_init(&acpi_battery_sysctl_ctx);
acpi_battery_sysctl_tree = SYSCTL_ADD_NODE(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(sc->acpi_sysctl_tree), OID_AUTO, "battery",
CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "battery status and info");
SYSCTL_ADD_PROC(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "life", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT,
&acpi_battery_battinfo.cap, 0, acpi_battery_sysctl, "I",
"percent capacity remaining");
SYSCTL_ADD_PROC(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "time", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT,
&acpi_battery_battinfo.min, 0, acpi_battery_sysctl, "I",
"remaining time in minutes");
SYSCTL_ADD_PROC(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "rate", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT,
&acpi_battery_battinfo.rate, 0, acpi_battery_sysctl, "I",
"present rate in mW");
SYSCTL_ADD_PROC(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "state", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT,
&acpi_battery_battinfo.state, 0, acpi_battery_sysctl, "I",
"current status flags");
SYSCTL_ADD_PROC(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "units", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT,
NULL, 0, acpi_battery_units_sysctl, "I", "number of batteries");
SYSCTL_ADD_INT(&acpi_battery_sysctl_ctx,
SYSCTL_CHILDREN(acpi_battery_sysctl_tree),
OID_AUTO, "info_expire", CTLFLAG_RW,
&acpi_battery_info_expire, 0,
"time in seconds until info is refreshed");
acpi_batteries_initialized = TRUE;
out:
if (error) {
acpi_deregister_ioctl(ACPIIO_BATT_GET_UNITS, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BATTINFO, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BATTINFO_V1, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BIF, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BIX, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BST, acpi_battery_ioctl);
acpi_deregister_ioctl(ACPIIO_BATT_GET_BST_V1, acpi_battery_ioctl);
}
return (error);
}