Home | History | Annotate | Line # | Download | only in acpi
apei_reg.c revision 1.1
      1  1.1  riastrad /*	$NetBSD: apei_reg.c,v 1.1 2024/03/20 17:11:44 riastradh Exp $	*/
      2  1.1  riastrad 
      3  1.1  riastrad /*-
      4  1.1  riastrad  * Copyright (c) 2024 The NetBSD Foundation, Inc.
      5  1.1  riastrad  * All rights reserved.
      6  1.1  riastrad  *
      7  1.1  riastrad  * Redistribution and use in source and binary forms, with or without
      8  1.1  riastrad  * modification, are permitted provided that the following conditions
      9  1.1  riastrad  * are met:
     10  1.1  riastrad  * 1. Redistributions of source code must retain the above copyright
     11  1.1  riastrad  *    notice, this list of conditions and the following disclaimer.
     12  1.1  riastrad  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  riastrad  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  riastrad  *    documentation and/or other materials provided with the distribution.
     15  1.1  riastrad  *
     16  1.1  riastrad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  riastrad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  riastrad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  riastrad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  riastrad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  riastrad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  riastrad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  riastrad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  riastrad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  riastrad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  riastrad  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  riastrad  */
     28  1.1  riastrad 
     29  1.1  riastrad /*
     30  1.1  riastrad  * APEI register access for ERST/EINJ action instructions
     31  1.1  riastrad  */
     32  1.1  riastrad 
     33  1.1  riastrad #include <sys/cdefs.h>
     34  1.1  riastrad __KERNEL_RCSID(0, "$NetBSD: apei_reg.c,v 1.1 2024/03/20 17:11:44 riastradh Exp $");
     35  1.1  riastrad 
     36  1.1  riastrad #include <sys/types.h>
     37  1.1  riastrad 
     38  1.1  riastrad #include <dev/acpi/acpivar.h>
     39  1.1  riastrad #include <dev/acpi/apei_reg.h>
     40  1.1  riastrad 
     41  1.1  riastrad /*
     42  1.1  riastrad  * apei_read_register(Register, Mask, &X)
     43  1.1  riastrad  *
     44  1.1  riastrad  *	Read from Register, shifted out of position and then masked
     45  1.1  riastrad  *	with Mask, and store the result in X.
     46  1.1  riastrad  *
     47  1.1  riastrad  *	https://uefi.org/specs/ACPI/6.5/18_Platform_Error_Interfaces.html#read-register
     48  1.1  riastrad  *
     49  1.1  riastrad  *	(I'm guessing this applies to both ERST and EINJ, even though
     50  1.1  riastrad  *	that section is under the ERST part.)
     51  1.1  riastrad  */
     52  1.1  riastrad ACPI_STATUS
     53  1.1  riastrad apei_read_register(ACPI_GENERIC_ADDRESS *Register, uint64_t Mask, uint64_t *p)
     54  1.1  riastrad {
     55  1.1  riastrad 	const uint8_t BitOffset = Register->BitOffset;
     56  1.1  riastrad 	uint64_t X;
     57  1.1  riastrad 	ACPI_STATUS rv;
     58  1.1  riastrad 
     59  1.1  riastrad 	rv = AcpiRead(&X, Register);
     60  1.1  riastrad 	if (ACPI_FAILURE(rv)) {
     61  1.1  riastrad 		*p = 0;		/* XXX */
     62  1.1  riastrad 		return rv;
     63  1.1  riastrad 	}
     64  1.1  riastrad 	X >>= BitOffset;
     65  1.1  riastrad 	X &= Mask;
     66  1.1  riastrad 
     67  1.1  riastrad 	*p = X;
     68  1.1  riastrad 	return AE_OK;
     69  1.1  riastrad }
     70  1.1  riastrad 
     71  1.1  riastrad /*
     72  1.1  riastrad  * apei_write_register(Register, Mask, preserve_register, X)
     73  1.1  riastrad  *
     74  1.1  riastrad  *	Write X, masked with Mask and shifted into position, to
     75  1.1  riastrad  *	Register, preserving other bits if preserve_register is true.
     76  1.1  riastrad  *
     77  1.1  riastrad  *	https://uefi.org/specs/ACPI/6.5/18_Platform_Error_Interfaces.html#write-register
     78  1.1  riastrad  *
     79  1.1  riastrad  *	Note: The Preserve Register semantics is based on the clearer
     80  1.1  riastrad  *	indentation at
     81  1.1  riastrad  *	https://uefi.org/sites/default/files/resources/ACPI_5_1release.pdf#page=714
     82  1.1  riastrad  *	which has been lost in more recent versions of the spec.
     83  1.1  riastrad  */
     84  1.1  riastrad ACPI_STATUS
     85  1.1  riastrad apei_write_register(ACPI_GENERIC_ADDRESS *Register, uint64_t Mask,
     86  1.1  riastrad     bool preserve_register, uint64_t X)
     87  1.1  riastrad {
     88  1.1  riastrad 	const uint8_t BitOffset = Register->BitOffset;
     89  1.1  riastrad 	ACPI_STATUS rv;
     90  1.1  riastrad 
     91  1.1  riastrad 	X &= Mask;
     92  1.1  riastrad 	X <<= BitOffset;
     93  1.1  riastrad 	if (preserve_register) {
     94  1.1  riastrad 		uint64_t Y;
     95  1.1  riastrad 
     96  1.1  riastrad 		rv = AcpiRead(&Y, Register);
     97  1.1  riastrad 		if (ACPI_FAILURE(rv))
     98  1.1  riastrad 			return rv;
     99  1.1  riastrad 		Y &= ~(Mask << BitOffset);
    100  1.1  riastrad 		X |= Y;
    101  1.1  riastrad 	}
    102  1.1  riastrad 	return AcpiWrite(X, Register);
    103  1.1  riastrad }
    104