arch/arm-native/soc/broadcom/2708/gpio/gpio_init.c

   1 /*
   2     Copyright © 2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 0
   7
   8 #include <aros/debug.h>
   9 #include <aros/symbolsets.h>
  10 #include <aros/libcall.h>
  11 #include <proto/kernel.h>
  12 #include <proto/exec.h>
  13 #include <proto/gpio.h>
  14
  15 #include "gpio_private.h"
  16
  17 APTR KernelBase __attribute__((used)) = NULL;
  18
  19 static int gpio_init(struct GPIOBase *GPIOBase)
  20 {
  21     int retval = FALSE;
  22
  23     D(bug("[GPIO] %s()\n", __PRETTY_FUNCTION__));
  24
  25     KernelBase = OpenResource("kernel.resource");
  26
  27     if ((GPIOBase->gpio_periiobase = KrnGetSystemAttr(KATTR_PeripheralBase)) != 0)
  28     {
  29         InitSemaphore(&GPIOBase->gpio_Sem);
  30
  31         D(bug("[GPIO] %s: Initialised Semaphore @ 0x%p\n", __PRETTY_FUNCTION__, &GPIOBase->gpio_Sem));
  32
  33         retval = TRUE;
  34     }
  35     return retval;
  36 }
  37
  38 AROS_LH2(void, GPIOSet,
  39                 AROS_LHA( unsigned int, pin, D0),
  40                 AROS_LHA( unsigned int, val, D1),
  41                 struct GPIOBase *, GPIOBase, 1, Gpio)
  42 {
  43     AROS_LIBFUNC_INIT
  44
  45     volatile unsigned int reg;
  46     unsigned int bit;
  47
  48     D(bug("[GPIO] %s(#%d,%d)\n", __PRETTY_FUNCTION__, pin, val));
  49
  50     if (GPIOBase->gpio_periiobase && (pin <= 53))
  51     {
  52         reg = val? GPSET0: GPCLR0;
  53         reg += (pin >> 5) << 2; /* (pin / 32) << 2 */
  54
  55         bit = 1 << (pin & 0x1F);
  56
  57         ObtainSemaphore(&GPIOBase->gpio_Sem);
  58
  59         *(volatile unsigned int *)reg = bit;
  60
  61         ReleaseSemaphore(&GPIOBase->gpio_Sem);
  62     }
  63
  64     AROS_LIBFUNC_EXIT
  65 }
  66
  67 AROS_LH2(void, GPIOSetFunc,
  68                 AROS_LHA( unsigned int, pin, D0),
  69                 AROS_LHA( unsigned int, func, D1),
  70                 struct GPIOBase *, GPIOBase, 2, Gpio)
  71 {
  72     AROS_LIBFUNC_INIT
  73
  74     volatile unsigned int reg;
  75
  76     D(bug("[GPIO] %s(#%d,%d)\n", __PRETTY_FUNCTION__, pin, func));
  77
  78     if (GPIOBase->gpio_periiobase && (pin <= 53))
  79     {
  80         reg = GPFSEL0;
  81         while (pin >= 10) {
  82             pin -= 10;
  83             reg += 4;
  84         }
  85
  86         pin += (pin << 1);
  87         func <<= pin;
  88
  89         ObtainSemaphore(&GPIOBase->gpio_Sem);
  90
  91         *(volatile unsigned int *)reg = func;
  92
  93         ReleaseSemaphore(&GPIOBase->gpio_Sem);
  94     }
  95
  96     AROS_LIBFUNC_EXIT
  97 }
  98
  99 ADD2INITLIB(gpio_init, 0)