freebsd-skq/usr.sbin/acpi/amldb/aml/aml_region.c

/*-
 * Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
 * Copyright (c) 2000 Munehiro Matsuda <haro@tk.kubota.co.jp>
 * 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.
 *
 *	$Id: aml_region.c,v 1.10 2000/08/09 14:47:44 iwasaki Exp $
 *	$FreeBSD$
 */

/*
 * Region I/O subroutine
 */

#include "opt_acpi.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>

#include <machine/bus.h>
#include <machine/resource.h>
#include <sys/rman.h>

#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
#include <aml/aml_common.h>
#include <aml/aml_region.h>
#include <aml/aml_name.h>

#ifndef ACPI_NO_OSDFUNC_INLINE
#include <machine/acpica_osd.h>
#endif

/*
 * Dummy functions for aml_region_io_simple()
 */
u_int32_t
aml_region_prompt_read(struct aml_region_handle *h, u_int32_t value)
{

	return (value);
}

u_int32_t
aml_region_prompt_write(struct aml_region_handle *h, u_int32_t value)
{

	return (value);
}

int
aml_region_prompt_update_value(u_int32_t orgval, u_int32_t value,
    struct aml_region_handle *h)
{
	return (0);
}

/*
 * Primitive functions for aml_region_io_simple()
 */
int
aml_region_read_simple(struct aml_region_handle *h, vm_offset_t offset, u_int32_t *valuep)
{
	u_int32_t value;

	switch (h->regtype) {
	case AML_REGION_SYSMEM:
		/* XXX should be MI */
		switch (h->unit) {
		case 1:
			value = *(volatile u_int8_t *)(h->vaddr + offset);
			value &= 0xff;
			break;
		case 2:
			value = *(volatile u_int16_t *)(h->vaddr + offset);
			value &= 0xffff;
			break;
		case 4:
			value = *(volatile u_int32_t *)(h->vaddr + offset);
			break;
		}
		break;
	case AML_REGION_SYSIO:
		switch (h->unit) {
		case 1:
			value = OsdIn8(h->addr + offset);
			value &= 0xff;
			break;
		case 2:
			value = OsdIn16(h->addr + offset);
			value &= 0xffff;
			break;
		case 4:
			value = OsdIn32(h->addr + offset);
			break;
		}
		break;
	case AML_REGION_PCICFG:
		switch (h->unit) {
		case 1:
			OsdReadPciCfgByte(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, (UINT8 *)&value);
			value &= 0xff;
			break;
		case 2:
			OsdReadPciCfgWord(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, (UINT16 *)&value);
			value &= 0xffff;
			break;
		case 4:
			OsdReadPciCfgDword(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, &value);
			break;
		}
		break;
	default:
		printf("aml_region_read_simple: not supported yet (%d)\n",
		    h->regtype);
		value = 0;
		break;
	}
	*valuep = value;
	return (0);
}

int
aml_region_write_simple(struct aml_region_handle *h, vm_offset_t offset, u_int32_t value)
{

	switch (h->regtype) {
	case AML_REGION_SYSMEM:
		/* XXX should be MI */
		switch (h->unit) {
		case 1:
			value &= 0xff;
			*(volatile u_int8_t *)(h->vaddr + offset) = value;
			break;
		case 2:
			value &= 0xffff;
			*(volatile u_int16_t *)(h->vaddr + offset) = value;
			break;
		case 4:
			*(volatile u_int32_t *)(h->vaddr + offset) = value;
			break;
		}
		break;
	case AML_REGION_SYSIO:
		switch (h->unit) {
		case 1:
			value &= 0xff;
			OsdOut8(h->addr + offset, value);
			break;
		case 2:
			value &= 0xffff;
			OsdOut16(h->addr + offset, value);
			break;
		case 4:
			OsdOut32(h->addr + offset, value);
			break;
		}
		break;
	case AML_REGION_PCICFG:
		switch (h->unit) {
		case 1:
			OsdWritePciCfgByte(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, value);
			break;
		case 2:
			OsdWritePciCfgWord(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, value);
			break;
		case 4:
			OsdWritePciCfgDword(h->pci_bus, h->pci_devfunc,
			    h->addr + offset, value);
			break;
		}
		break;
	default:
		printf("aml_region_write_simple: not supported yet (%d)\n",
		    h->regtype);
		break;
	}

	return (0);
}

static int
aml_region_io_buffer(boolean_t io, int regtype, u_int32_t flags,
    u_int8_t *buffer, u_int32_t baseaddr, u_int32_t bitoffset, u_int32_t bitlen)
{
	vm_offset_t	addr, vaddr;
	size_t		len;
	const char	*funcname[] = {
		"aml_region_read_into_buffer",
		"aml_region_write_from_buffer"
	};

	if (regtype != AML_REGION_SYSMEM) {
		printf("%s: region type isn't system memory!\n", funcname[io]);
		return (-1);
	}

	if (bitlen % 8) {
		printf("%s: bit length isn't a multiple of 8!\n", funcname[io]);
	}
	if (bitoffset % 8) {
		printf("%s: bit offset isn't a multiple of 8!\n", funcname[io]);
	}

	addr = baseaddr + bitoffset / 8;
	len = bitlen / 8 + ((bitlen % 8) ? 1 : 0);

	OsdMapMemory((void *)addr, len, (void **)&vaddr);

	switch (io) {
	case AML_REGION_INPUT:
		bcopy((void *)vaddr, (void *)buffer, len);
		break;
	case AML_REGION_OUTPUT:
		bcopy((void *)buffer, (void *)vaddr, len);
		break;
	}

	OsdUnMapMemory((void *)vaddr, len);

	return (0);
}

u_int32_t
aml_region_read(struct aml_environ *env, int regtype, u_int32_t flags,
    u_int32_t addr, u_int32_t bitoffset, u_int32_t bitlen)
{
	int	value;
	int	state;

	AML_REGION_READ_DEBUG(regtype, flags, addr, bitoffset, bitlen);

	state = aml_region_io(env, AML_REGION_INPUT, regtype,
	    flags, &value, addr, bitoffset, bitlen);
	AML_SYSASSERT(state != -1);

        return (value);
}

int
aml_region_read_into_buffer(struct aml_environ *env, int regtype,
    u_int32_t flags, u_int32_t addr, u_int32_t bitoffset, u_int32_t bitlen,
    u_int8_t *buffer)
{
	int	state;

	AML_REGION_READ_INTO_BUFFER_DEBUG(regtype, flags, addr, bitoffset, bitlen);
	state = aml_region_io_buffer(AML_REGION_INPUT, regtype, flags,
	    buffer, addr, bitoffset, bitlen);

        return (state);
}

int
aml_region_write(struct aml_environ *env, int regtype, u_int32_t flags,
    u_int32_t value, u_int32_t addr, u_int32_t bitoffset, u_int32_t bitlen)
{
	int	state;

	AML_REGION_WRITE_DEBUG(regtype, flags, value, addr, bitoffset, bitlen);

	state = aml_region_io(env, AML_REGION_OUTPUT, regtype,
	    flags, &value, addr, bitoffset, bitlen);
	AML_SYSASSERT(state != -1);

        return (state);
}

int
aml_region_write_from_buffer(struct aml_environ *env, int regtype,
    u_int32_t flags, u_int8_t *buffer, u_int32_t addr, u_int32_t bitoffset,
    u_int32_t bitlen)
{
	int	state;

	AML_REGION_WRITE_FROM_BUFFER_DEBUG(regtype, flags,
	    addr, bitoffset, bitlen);

	state = aml_region_io_buffer(AML_REGION_OUTPUT, regtype, flags,
	    buffer, addr, bitoffset, bitlen);

        return (state);
}

int
aml_region_bcopy(struct aml_environ *env, int regtype,
    u_int32_t flags, u_int32_t addr, u_int32_t bitoffset, u_int32_t bitlen,
    u_int32_t dflags, u_int32_t daddr, u_int32_t dbitoffset, u_int32_t dbitlen)
{
	vm_offset_t	from_addr, from_vaddr;
	vm_offset_t	to_addr, to_vaddr;
	size_t		len;

	AML_REGION_BCOPY_DEBUG(regtype, flags, addr, bitoffset, bitlen,
	    dflags, daddr, dbitoffset, dbitlen);

	if (regtype != AML_REGION_SYSMEM) {
		printf("aml_region_bcopy: region type isn't system memory!\n");
		return (-1);
	}

	if ((bitlen % 8) || (dbitlen % 8)) {
		printf("aml_region_bcopy: bit length isn't a multiple of 8!\n");
	}
	if ((bitoffset % 8) || (dbitoffset % 8)) {
		printf("aml_region_bcopy: bit offset isn't a multiple of 8!\n");
	}

	from_addr = addr + bitoffset / 8;
	to_addr = daddr + dbitoffset / 8;

	len = (bitlen > dbitlen) ? dbitlen : bitlen;
	len = len / 8 + ((len % 8) ? 1 : 0);

	OsdMapMemory((void *)from_addr, len, (void **)&from_vaddr);
	OsdMapMemory((void *)to_addr, len, (void **)&to_vaddr);

	bcopy((void *)from_vaddr, (void *)to_vaddr, len);

	OsdUnMapMemory((void *)from_vaddr, len);
	OsdUnMapMemory((void *)to_vaddr, len);

	return (0);
}