2 * (c) 2011 Alexander Warg <warg@os.inf.tu-dresden.de>
3 * economic rights: Technische Universität Dresden (Germany)
5 * This file is part of TUD:OS and distributed under the terms of the
6 * GNU General Public License 2.
7 * Please see the COPYING-GPL-2 file for details.
12 #include "hw_device.h"
14 #include "vbus_factory.h"
18 #include <l4/vbus/vbus_gpio-ops.h>
26 class Gpio : public Device, public Dev_feature
29 int dispatch(l4_umword_t, l4_uint32_t func, L4::Ipc::Iostream &ios);
31 explicit Gpio(Hw::Device *d)
32 : _hwd(dynamic_cast<Hw::Gpio_chip*>(d)), _mask(0)
36 for (unsigned i = 0; i < Max_pins; ++i)
40 int add_filter(cxx::String const &tag, cxx::String const &)
47 int add_filter(cxx::String const &tag, unsigned long long val)
51 _mask |= (1UL << val);
55 int add_filter(cxx::String const &tag, unsigned long long s, unsigned long long e)
59 _mask |= ~(~0UL << (e - s + 1)) << s;
63 char const *hid() const { return "GPIO"; }
64 void set_host(Device *d) { _host = d; }
65 Device *host() const { return _host; }
67 bool match_hw_feature(const Hw::Dev_feature*) const
71 enum { Max_pins = 32 };
78 int setup(L4::Ipc::Iostream &ios);
79 int config_pad(L4::Ipc::Iostream &ios);
80 int get(L4::Ipc::Iostream &ios);
81 int set(L4::Ipc::Iostream &ios);
82 int multi_setup(L4::Ipc::Iostream &ios);
83 int multi_config_pad(L4::Ipc::Iostream &ios);
84 int multi_get(L4::Ipc::Iostream &ios);
85 int multi_set(L4::Ipc::Iostream &ios);
86 int to_irq(L4::Ipc::Iostream &ios);
88 void check(unsigned pin)
93 if (!((1UL << pin) & _mask))
97 void check_mask(unsigned mask)
107 Gpio::setup(L4::Ipc::Iostream &ios)
111 ios >> pin >> mode >> value;
113 _hwd->setup(pin, mode, value);
118 Gpio::config_pad(L4::Ipc::Iostream &ios)
120 unsigned pin, func, value;
121 ios >> pin >> func >> value;
123 _hwd->config_pad(pin, _mask, func, value);
128 Gpio::get(L4::Ipc::Iostream &ios)
133 return _hwd->get(pin);
137 Gpio::set(L4::Ipc::Iostream &ios)
143 _hwd->set(pin, value);
148 Gpio::multi_setup(L4::Ipc::Iostream &ios)
150 unsigned mask, mode, outvalue;
151 ios >> mask >> mode >> outvalue;
153 _hwd->multi_setup(mask, mode, outvalue);
158 Gpio::multi_config_pad(L4::Ipc::Iostream &ios)
160 unsigned mask, func, value;
161 ios >> mask >> func >> value;
163 _hwd->multi_config_pad(mask, func, value);
168 Gpio::multi_get(L4::Ipc::Iostream &ios)
170 unsigned data = _hwd->multi_get();
171 ios << (unsigned)(data & _mask);
176 Gpio::multi_set(L4::Ipc::Iostream &ios)
181 _hwd->multi_set(mask, data);
186 Gpio::to_irq(L4::Ipc::Iostream &ios)
192 if (_irqs[pin] == -1)
194 // we have to allocate the IRQ...
195 // if it fails we mark the IRQ as unavailable (-L4_ENODEV)
196 _irqs[pin] = -L4_ENODEV;
198 int irqnum = _hwd->get_irq(pin);
202 if (System_bus *sb = dynamic_cast<System_bus *>(get_root()))
204 int virq = sb->sw_icu()->alloc_irq(Sw_icu::S_allow_set_mode,
205 Sw_icu::real_irq(irqnum));
218 Gpio::dispatch(l4_umword_t, l4_uint32_t func, L4::Ipc::Iostream &ios)
224 case L4VBUS_GPIO_OP_SETUP: return setup(ios);
225 case L4VBUS_GPIO_OP_CONFIG_PAD: return config_pad(ios);
226 case L4VBUS_GPIO_OP_GET: return get(ios);
227 case L4VBUS_GPIO_OP_SET: return set(ios);
228 case L4VBUS_GPIO_OP_MULTI_SETUP: return multi_setup(ios);
229 case L4VBUS_GPIO_OP_MULTI_CONFIG_PAD: return multi_config_pad(ios);
230 case L4VBUS_GPIO_OP_MULTI_GET: return multi_get(ios);
231 case L4VBUS_GPIO_OP_MULTI_SET: return multi_set(ios);
232 case L4VBUS_GPIO_OP_TO_IRQ: return to_irq(ios);
233 default: return -L4_ENOSYS;
243 static Dev_factory_t<Gpio, Hw::Gpio_device> __gpio_factory;