diff options
author | Martin Braun <martin.braun@ettus.com> | 2017-12-12 09:59:50 -0800 |
---|---|---|
committer | Martin Braun <martin.braun@ettus.com> | 2017-12-22 15:05:58 -0800 |
commit | d3e6dd11406893bfbc5537dfbe74d8151bbc1280 (patch) | |
tree | 8663263b3c5a4ff7202e01a5f9c5c6bb23969829 /mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py | |
parent | ea7cc7f8250cd9bdb41c1f22703d38be91fb6a84 (diff) | |
download | uhd-d3e6dd11406893bfbc5537dfbe74d8151bbc1280.tar.gz uhd-d3e6dd11406893bfbc5537dfbe74d8151bbc1280.tar.bz2 uhd-d3e6dd11406893bfbc5537dfbe74d8151bbc1280.zip |
mpm: Harmonize imports, tidy + sort modules
- Moved nijesdcore to cores/
- Moved udev, net, dtoverlay, uio to sys_utils/
- Made all imports non-relative (except in __init__.py files)
- Removed some unnecessary imports
- Reordered some imports for Python conventions
Diffstat (limited to 'mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py')
-rw-r--r-- | mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py | 199 |
1 files changed, 199 insertions, 0 deletions
diff --git a/mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py b/mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py new file mode 100644 index 000000000..f8384a3b8 --- /dev/null +++ b/mpm/python/usrp_mpm/sys_utils/sysfs_gpio.py @@ -0,0 +1,199 @@ +# +# Copyright 2017 Ettus Research (National Instruments) +# +# This program is free software: you can redistribute it and/or modify +# it under the terms of the GNU General Public License as published by +# the Free Software Foundation, either version 3 of the License, or +# (at your option) any later version. +# +# This program is distributed in the hope that it will be useful, +# but WITHOUT ANY WARRANTY; without even the implied warranty of +# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +# GNU General Public License for more details. +# +# You should have received a copy of the GNU General Public License +# along with this program. If not, see <http://www.gnu.org/licenses/>. +# +""" +Access to GPIOs mapped into the PS via sysfs +""" + +import os +from builtins import object +import pyudev +from usrp_mpm.mpmlog import get_logger + +GPIO_SYSFS_BASE_DIR = '/sys/class/gpio' +GPIO_SYSFS_LABELFILE = 'label' +GPIO_SYSFS_VALUEFILE = 'value' + +def get_all_gpio_devs(parent_dev=None): + """ + Returns a list of all GPIO chips available through sysfs. Will look + something like ['gpiochip882', 'gpiochip123', ...] + + If there are multiple devices with the same label (example: daughterboards + may have a single label for a shared component), a parent device needs to + be provided to disambiguate. + + Arguments: + parent_dev -- A parent udev device. If this is provided, only GPIO devices + which are a child of the parent device are returned. + + Example: + >>> parent_dev = pyudev.Devices.from_sys_path( + pyudev.Context(), '/sys/class/i2c-adapter/i2c-10') + >>> get_all_gpio_devs(parent_dev) + """ + try: + context = pyudev.Context() + gpios = [device.sys_name + for device in context.list_devices( + subsystem="gpio").match_parent(parent_dev) + if device.device_number == 0 + ] + return gpios + except OSError: + # Typically means GPIO not available, maybe no overlay + return [] + +def get_gpio_map_info(gpio_dev): + """ + Returns all the map info for a given GPIO device. + Example: If pio_dev is 'gpio882', it will list all files + in /sys/class/gpio/gpio882/ and create a dictionary with filenames + as keys and content as value. Subdirs are skipped. + + Numbers are casted to numbers automatically. Strings remain strings. + """ + map_info = {} + map_info_path = os.path.join( + GPIO_SYSFS_BASE_DIR, gpio_dev, + ) + for info_file in os.listdir(map_info_path): + if not os.path.isfile(os.path.join(map_info_path, info_file)): + continue + map_info_value = open(os.path.join(map_info_path, info_file), 'r').read().strip() + try: + map_info[info_file] = int(map_info_value, 0) + except ValueError: + map_info[info_file] = map_info_value + # Manually add GPIO number + context = pyudev.Context() + map_info['sys_number'] = int( + pyudev.Devices.from_name(context, subsystem="gpio", sys_name=gpio_dev).sys_number + ) + return map_info + +def find_gpio_device(label, parent_dev=None, logger=None): + """ + Given a label, returns a tuple (uio_device, map_info). + uio_device is something like 'gpio882'. map_info is a dictionary with + information regarding the GPIO device read from the map info sysfs dir. + """ + gpio_devices = get_all_gpio_devs(parent_dev) + if logger: + logger.trace("Found the following UIO devices: `{0}'".format(','.join(gpio_devices))) + for gpio_device in gpio_devices: + map_info = get_gpio_map_info(gpio_device) + if logger: + logger.trace("{0} has map info: {1}".format(gpio_device, map_info)) + if map_info.get('label') == label: + if logger: + logger.trace("Device matches label: `{0}'".format(gpio_device)) + return gpio_device, map_info + if logger: + logger.warning("Found no matching gpio device for label `{0}'".format(label)) + return None, None + +class SysFSGPIO(object): + """ + API for accessing GPIOs mapped into userland via sysfs + """ + + def __init__(self, label, use_mask, ddr, init_value=0, parent_dev=None): + assert (use_mask & ddr) == ddr + self.log = get_logger("SysFSGPIO") + self._label = label + self._use_mask = use_mask + self._ddr = ddr + self._init_value = init_value + self.log.trace("Generating SysFSGPIO object for label `{}'...".format(label)) + self._gpio_dev, self._map_info = \ + find_gpio_device(label, parent_dev, self.log) + if self._gpio_dev is None: + self.log.error("Could not find GPIO device with label `{}'.".format(label)) + self.log.trace("GPIO base number is {}".format(self._map_info.get("sys_number"))) + self._base_gpio = self._map_info.get("sys_number") + self.init(self._map_info['ngpio'], + self._base_gpio, + self._use_mask, + self._ddr, + self._init_value) + + def init(self, n_gpio, base, use_mask, ddr, init_value=0): + """ + Guarantees that all the devices are created accordingly + + E.g., if use_mask & 0x1 is True, it makes sure that 'gpioXXX' is exported. + Also sets the DDRs. + """ + gpio_list = [x for x in range(n_gpio) if (1<<x) & use_mask] + self.log.trace("Initializing {} GPIOs...".format(len(gpio_list))) + for gpio_idx in gpio_list: + gpio_num = base + gpio_idx + ddr_out = ddr & (1<<gpio_idx) + ini_v = init_value & (1<<gpio_idx) + gpio_path = os.path.join(GPIO_SYSFS_BASE_DIR, 'gpio{}'.format(gpio_num)) + if not os.path.exists(gpio_path): + self.log.trace("Creating GPIO path `{}'...".format(gpio_path)) + open(os.path.join(GPIO_SYSFS_BASE_DIR, 'export'), 'w').write('{}'.format(gpio_num)) + ddr_str = 'out' if ddr_out else 'in' + ddr_str = 'high' if ini_v else ddr_str + self.log.trace("On GPIO path `{}', setting DDR mode to {}.".format(gpio_path, ddr_str)) + open(os.path.join(GPIO_SYSFS_BASE_DIR, gpio_path, 'direction'), 'w').write(ddr_str) + + def set(self, gpio_idx, value=None): + """ + Assert a GPIO at given index. + + Note: The GPIO must be in the valid range, and it's DDR value must be + high (for "out"). + """ + if value is None: + value = 1 + assert (1<<gpio_idx) & self._use_mask + assert (1<<gpio_idx) & self._ddr + gpio_num = self._base_gpio + gpio_idx + gpio_path = os.path.join(GPIO_SYSFS_BASE_DIR, 'gpio{}'.format(gpio_num)) + value_path = os.path.join(gpio_path, GPIO_SYSFS_VALUEFILE) + self.log.trace("Writing value `{}' to `{}'...".format(value, value_path)) + assert os.path.exists(value_path) + open(value_path, 'w').write('{}'.format(value)) + + def reset(self, gpio_idx): + """ + Deassert a GPIO at given index. + + Note: The GPIO must be in the valid range, and it's DDR value must be + high (for "out"). + """ + self.set(gpio_idx, value=0) + + def get(self, gpio_idx): + """ + Read back a GPIO at given index. + + Note: The GPIO must be in the valid range, and it's DDR value must be + low (for "in"). + """ + assert (1<<gpio_idx) & self._use_mask + assert (1<<gpio_idx) & (~self._ddr) + gpio_num = self._base_gpio + gpio_idx + gpio_path = os.path.join(GPIO_SYSFS_BASE_DIR, 'gpio{}'.format(gpio_num)) + value_path = os.path.join(gpio_path, GPIO_SYSFS_VALUEFILE) + assert os.path.exists(value_path) + read_value = int(open(value_path, 'r').read().strip()) + self.log.trace("Reading value {} from `{}'...".format(read_value, value_path)) + return read_value + |