freebsd-dev/sys/dev/acpi_support/acpi_aiboost.c

339 lines
8.1 KiB
C
Raw Normal View History

/*-
* Copyright (c) 2006 Takanori Watanabe
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include "opt_acpi.h"
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <contrib/dev/acpica/acpi.h>
#include "acpi_if.h"
#include <sys/module.h>
#include <dev/acpica/acpivar.h>
#include <sys/sysctl.h>
#include <sys/malloc.h>
#include <sys/sysctl.h>
#define _COMPONENT ACPI_OEM
ACPI_MODULE_NAME("AIBOOST")
#define DESCSTRLEN 32
struct acpi_aiboost_element{
ACPI_HANDLE h;
uint32_t id;
char desc[DESCSTRLEN];
};
ACPI_SERIAL_DECL(aiboost, "ACPI AIBOOST");
/**/
struct acpi_aiboost_component{
unsigned int num;
struct acpi_aiboost_element elem[1];
};
struct acpi_aiboost_softc {
int pid;
struct acpi_aiboost_component *temp;
struct acpi_aiboost_component *volt;
struct acpi_aiboost_component *fan;
};
static int acpi_aiboost_probe(device_t dev);
static int acpi_aiboost_attach(device_t dev);
static int acpi_aiboost_detach(device_t dev);
static device_method_t acpi_aiboost_methods[] = {
/* Device interface */
DEVMETHOD(device_probe, acpi_aiboost_probe),
DEVMETHOD(device_attach, acpi_aiboost_attach),
DEVMETHOD(device_detach, acpi_aiboost_detach),
{0, 0}
};
static driver_t acpi_aiboost_driver = {
"acpi_aiboost",
acpi_aiboost_methods,
sizeof(struct acpi_aiboost_softc),
};
static devclass_t acpi_aiboost_devclass;
DRIVER_MODULE(acpi_aiboost, acpi, acpi_aiboost_driver, acpi_aiboost_devclass,
0, 0);
MODULE_DEPEND(acpi_aiboost, acpi, 1, 1, 1);
static char *abs_id[] = {"ATK0110", NULL};
/*VSIF, RVLT, SVLT, TSIF, RTMP, STMP FSIF, RFAN, SFAN */
static ACPI_STATUS acpi_aiboost_getcomponent(device_t dev, char *name, struct acpi_aiboost_component **comp)
{
ACPI_BUFFER buf, buf2;
ACPI_OBJECT *o,*elem,*subobj;
ACPI_STATUS status;
struct acpi_aiboost_component *c = NULL;
int i;
buf.Pointer = NULL;
buf.Length = ACPI_ALLOCATE_BUFFER;
buf2.Pointer = NULL;
status = AcpiEvaluateObject(acpi_get_handle(dev), name, NULL, &buf);
if(ACPI_FAILURE(status))
return status;
o = buf.Pointer;
if(o->Type != ACPI_TYPE_PACKAGE)
goto error;
elem = o->Package.Elements;
if(elem->Type != ACPI_TYPE_INTEGER)
goto error;
c = malloc(sizeof(struct acpi_aiboost_component)
+ sizeof(struct acpi_aiboost_element)
* (elem->Integer.Value -1),
M_DEVBUF, M_ZERO|M_WAITOK);
*comp = c;
c->num = elem->Integer.Value;
for(i = 1 ; i < o->Package.Count; i++){
elem = &o->Package.Elements[i];
if(elem->Type != ACPI_TYPE_ANY){
printf("NOREF\n");
goto error;
}
c->elem[ i - 1].h = elem->Reference.Handle;
buf2.Pointer = NULL;
buf2.Length = ACPI_ALLOCATE_BUFFER;
status = AcpiEvaluateObject(c->elem[i - 1].h, NULL, NULL,
&buf2);
if(ACPI_FAILURE(status)){
printf("FETCH OBJECT\n");
goto error;
}
subobj = buf2.Pointer;
if(ACPI_FAILURE(acpi_PkgInt32(subobj,0, &c->elem[i -1].id))){
printf("ID FAILED\n");
goto error;
}
status = acpi_PkgStr(subobj, 1, c->elem[i - 1].desc,
sizeof(c->elem[i - 1].desc));
if(ACPI_FAILURE(status)){
if(status == E2BIG){
c->elem[i-1].desc[DESCSTRLEN-1] = 0;
}else{
printf("DESC FAILED %d\n", i-1);
goto error;
}
}
if(buf2.Pointer)
AcpiOsFree(buf2.Pointer);
}
if(buf.Pointer)
AcpiOsFree(buf.Pointer);
return 0;
error:
printf("BAD DATA\n");
if(buf.Pointer)
AcpiOsFree(buf.Pointer);
if(buf2.Pointer)
AcpiOsFree(buf2.Pointer);
if(c)
free(c, M_DEVBUF);
return AE_BAD_DATA;
}
static int
acpi_aiboost_get_value(ACPI_HANDLE handle, char *path, UINT32 number)
{
ACPI_OBJECT arg1, *ret;
ACPI_OBJECT_LIST args;
ACPI_BUFFER buf;
buf.Length = ACPI_ALLOCATE_BUFFER;
buf.Pointer = 0;
int val;
arg1.Type = ACPI_TYPE_INTEGER;
arg1.Integer.Value = number;
args.Count = 1;
args.Pointer = &arg1;
if(ACPI_FAILURE(AcpiEvaluateObject(handle, path, &args, &buf))){
return -1;
}
ret = buf.Pointer;
val = (ret->Type == ACPI_TYPE_INTEGER)? ret->Integer.Value : -1;
AcpiOsFree(buf.Pointer);
return val;
}
static int acpi_aiboost_temp_sysctl(SYSCTL_HANDLER_ARGS)
{
device_t dev = arg1;
int function = oidp->oid_arg2;
int error = 0, val;
ACPI_SERIAL_BEGIN(aiboost);
val = acpi_aiboost_get_value(acpi_get_handle(dev), "RTMP",function );
error = sysctl_handle_int(oidp, &val, 0 , req);
ACPI_SERIAL_END(aiboost);
return 0;
}
static int acpi_aiboost_volt_sysctl(SYSCTL_HANDLER_ARGS)
{
device_t dev = arg1;
int function = oidp->oid_arg2;
int error = 0, val;
ACPI_SERIAL_BEGIN(aiboost);
val = acpi_aiboost_get_value(acpi_get_handle(dev), "RVLT", function);
error = sysctl_handle_int(oidp, &val, 0 , req);
ACPI_SERIAL_END(aiboost);
return 0;
}
static int acpi_aiboost_fan_sysctl(SYSCTL_HANDLER_ARGS)
{
device_t dev = arg1;
int function = oidp->oid_arg2;
int error = 0, val;
ACPI_SERIAL_BEGIN(aiboost);
val = acpi_aiboost_get_value(acpi_get_handle(dev), "RFAN", function);
error = sysctl_handle_int(oidp, &val, 0 , req);
ACPI_SERIAL_END(aiboost);
return 0;
}
static int
acpi_aiboost_probe(device_t dev)
{
int ret = ENXIO;
if (ACPI_ID_PROBE(device_get_parent(dev), dev, abs_id)) {
device_set_desc(dev, "ASUStek AIBOOSTER");
ret = 0;
}
return (ret);
}
static int
acpi_aiboost_attach(device_t dev)
{
struct acpi_aiboost_softc *sc;
char nambuf[]="tempXXX";
int i;
sc = device_get_softc(dev);
if(ACPI_FAILURE(acpi_aiboost_getcomponent(dev, "TSIF", &sc->temp)))
goto error;
for(i= 0; i < sc->temp->num; i++){
sprintf(nambuf,"temp%d", i);
SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
OID_AUTO, nambuf,
CTLTYPE_INT|CTLFLAG_RD, dev,
sc->temp->elem[i].id,
acpi_aiboost_temp_sysctl,
"I", sc->temp->elem[i].desc);
}
if(ACPI_FAILURE(acpi_aiboost_getcomponent(dev, "VSIF", &sc->volt)))
goto error;
for(i= 0; i < sc->volt->num; i++){
sprintf(nambuf,"volt%d", i);
SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
OID_AUTO, nambuf,
CTLTYPE_INT|CTLFLAG_RD, dev,
sc->volt->elem[i].id,
acpi_aiboost_volt_sysctl,
"I", sc->volt->elem[i].desc);
}
if(ACPI_FAILURE(acpi_aiboost_getcomponent(dev, "FSIF", &sc->fan)))
goto error;
for(i= 0; i < sc->fan->num; i++){
sprintf(nambuf,"fan%d", i);
SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
OID_AUTO, nambuf,
CTLTYPE_INT|CTLFLAG_RD, dev,
sc->fan->elem[i].id,
acpi_aiboost_fan_sysctl,
"I", sc->fan->elem[i].desc);
}
return (0);
error:
return EINVAL;
}
static int
acpi_aiboost_detach(device_t dev)
{
struct acpi_aiboost_softc *sc = device_get_softc(dev);
if(sc->temp)
free(sc->temp, M_DEVBUF);
if(sc->volt)
free(sc->volt, M_DEVBUF);
if(sc->fan)
free(sc->fan, M_DEVBUF);
return (0);
}
#if 0
static int
acpi_aiboost_suspend(device_t dev)
{
struct acpi_aiboost_softc *sc = device_get_softc(dev);
return (0);
}
static int
acpi_aiboost_resume(device_t dev)
{
return (0);
}
#endif