arch/all-pc/acpi/writereg.c

   1 #include <asm/io.h>
   2 #include <resources/acpi.h>
   3
   4 #include "gas_io.h"
   5
   6 /*****************************************************************************
   7
   8     NAME */
   9 #include <proto/acpi.h>
  10
  11         AROS_LH2I(void, ACPI_WriteReg,
  12
  13 /*  SYNOPSIS */
  14         AROS_LHA(struct GENERIC_ACPI_ADDR *, reg, A0),
  15         AROS_LHA(IPTR, value, D0),
  16
  17 /*  LOCATION */
  18         struct ACPIBase *, ACPIBase, 4, Acpi)
  19
  20 /*  FUNCTION
  21         Write a value from the register specified by GAS
  22
  23     INPUTS
  24         reg   - a pointer to a generic address structure
  25         value - a value to write to the register
  26
  27     RESULT
  28         None
  29
  30     NOTES
  31         Only memory and I/O spaces are supported.
  32         64-bit registers are supported only in memory space and only on 64-bit platforms.
  33         The given GAS must address a complete register, not a data structure.
  34
  35     EXAMPLE
  36
  37     BUGS
  38
  39     SEE ALSO
  40
  41     INTERNALS
  42
  43 ******************************************************************************/
  44 {
  45     AROS_LIBFUNC_INIT
  46
  47     unsigned char size = GetSize(reg);
  48
  49     if (reg->register_bit_width != FullSize[reg->size])
  50     {
  51         /*
  52          * Partial bit field.
  53          * Read original value from the register and replace the needed bits.
  54          */
  55         unsigned long mask = ((1 << reg->register_bit_width) - 1) << reg->register_bit_offset;
  56         unsigned long old = ReadRegInt(reg, size);
  57
  58         value = (value << reg->register_bit_offset) & mask;
  59         value |= (old & ~mask);
  60     }
  61
  62     switch (reg->address_space_id)
  63     {
  64     case ACPI_SPACE_MEM:
  65         switch (size)
  66         {
  67         case ACPI_SIZE_BYTE:
  68             *((UBYTE *)(IPTR)reg->address) = value;
  69             break;
  70
  71         case ACPI_SIZE_WORD:
  72             *((UWORD *)(IPTR)reg->address) = value;
  73             break;
  74
  75         case ACPI_SIZE_DWORD:
  76             *((ULONG *)(IPTR)reg->address) = value;
  77             break;
  78
  79 #if __WORDSIZE == 64
  80         case ACPI_SIZE_QUAD:
  81             *((UQUAD *)(IPTR)reg->address) = value;
  82             break;
  83 #endif
  84         }
  85         break;
  86
  87     case ACPI_SPACE_IO:
  88         switch (size)
  89         {
  90         case ACPI_SIZE_BYTE:
  91             outb(value, reg->address);
  92             break;
  93
  94         case ACPI_SIZE_WORD:
  95             outw(value, reg->address);
  96             break;
  97
  98         case ACPI_SIZE_DWORD:
  99             outl(value, reg->address);
 100             break;
 101
 102         /* ACPI_SIZE_QUAD - not supported ? */
 103         }
 104         break;
 105     }
 106
 107     AROS_LIBFUNC_EXIT
 108 }