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