board/LaCie/common/cpld-gpio-bus.c

   1 /*
   2  * cpld-gpio-bus.c: provides support for the CPLD GPIO bus found on some LaCie
   3  * boards (as the 2Big/5Big Network v2 and the 2Big NAS). This parallel GPIO
   4  * bus exposes two registers (address and data). Each of this register is made
   5  * up of several dedicated GPIOs. An extra GPIO is used to notify the CPLD that
   6  * the registers have been updated.
   7  *
   8  * Mostly this bus is used to configure the LEDs on LaCie boards.
   9  *
  10  * Copyright (C) 2013 Simon Guinot <simon.guinot@sequanux.org>
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License as
  14  * published by the Free Software Foundation; either version 2 of
  15  * the License, or (at your option) any later version.
  16  */
  17
  18 #include <asm/arch/gpio.h>
  19 #include "cpld-gpio-bus.h"
  20
  21 static void cpld_gpio_bus_set_addr(struct cpld_gpio_bus *bus, unsigned addr)
  22 {
  23         int pin;
  24
  25         for (pin = 0; pin < bus->num_addr; pin++)
  26                 kw_gpio_set_value(bus->addr[pin], (addr >> pin) & 1);
  27 }
  28
  29 static void cpld_gpio_bus_set_data(struct cpld_gpio_bus *bus, unsigned data)
  30 {
  31         int pin;
  32
  33         for (pin = 0; pin < bus->num_data; pin++)
  34                 kw_gpio_set_value(bus->data[pin], (data >> pin) & 1);
  35 }
  36
  37 static void cpld_gpio_bus_enable_select(struct cpld_gpio_bus *bus)
  38 {
  39         /* The transfer is enabled on the raising edge. */
  40         kw_gpio_set_value(bus->enable, 0);
  41         kw_gpio_set_value(bus->enable, 1);
  42 }
  43
  44 void cpld_gpio_bus_write(struct cpld_gpio_bus *bus,
  45                          unsigned addr, unsigned value)
  46 {
  47         cpld_gpio_bus_set_addr(bus, addr);
  48         cpld_gpio_bus_set_data(bus, value);
  49         cpld_gpio_bus_enable_select(bus);
  50 }