drivers/pinctrl/pinctrl-utils.c

   1 /*
   2  * Utils functions to implement the pincontrol driver.
   3  *
   4  * Copyright (c) 2013, NVIDIA Corporation.
   5  *
   6  * Author: Laxman Dewangan <ldewangan@nvidia.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation version 2.
  11  *
  12  * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
  13  * whether express or implied; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  20  * 02111-1307, USA
  21  */
  22 #include <linux/device.h>
  23 #include <linux/export.h>
  24 #include <linux/kernel.h>
  25 #include <linux/pinctrl/pinctrl.h>
  26 #include <linux/of.h>
  27 #include <linux/slab.h>
  28 #include "core.h"
  29 #include "pinctrl-utils.h"
  30
  31 int pinctrl_utils_reserve_map(struct pinctrl_dev *pctldev,
  32                 struct pinctrl_map **map, unsigned *reserved_maps,
  33                 unsigned *num_maps, unsigned reserve)
  34 {
  35         unsigned old_num = *reserved_maps;
  36         unsigned new_num = *num_maps + reserve;
  37         struct pinctrl_map *new_map;
  38
  39         if (old_num >= new_num)
  40                 return 0;
  41
  42         new_map = krealloc(*map, sizeof(*new_map) * new_num, GFP_KERNEL);
  43         if (!new_map) {
  44                 dev_err(pctldev->dev, "krealloc(map) failed\n");
  45                 return -ENOMEM;
  46         }
  47
  48         memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map));
  49
  50         *map = new_map;
  51         *reserved_maps = new_num;
  52         return 0;
  53 }
  54 EXPORT_SYMBOL_GPL(pinctrl_utils_reserve_map);
  55
  56 int pinctrl_utils_add_map_mux(struct pinctrl_dev *pctldev,
  57                 struct pinctrl_map **map, unsigned *reserved_maps,
  58                 unsigned *num_maps, const char *group,
  59                 const char *function)
  60 {
  61         if (WARN_ON(*num_maps == *reserved_maps))
  62                 return -ENOSPC;
  63
  64         (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
  65         (*map)[*num_maps].data.mux.group = group;
  66         (*map)[*num_maps].data.mux.function = function;
  67         (*num_maps)++;
  68
  69         return 0;
  70 }
  71 EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_mux);
  72
  73 int pinctrl_utils_add_map_configs(struct pinctrl_dev *pctldev,
  74                 struct pinctrl_map **map, unsigned *reserved_maps,
  75                 unsigned *num_maps, const char *group,
  76                 unsigned long *configs, unsigned num_configs,
  77                 enum pinctrl_map_type type)
  78 {
  79         unsigned long *dup_configs;
  80
  81         if (WARN_ON(*num_maps == *reserved_maps))
  82                 return -ENOSPC;
  83
  84         dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs),
  85                               GFP_KERNEL);
  86         if (!dup_configs)
  87                 return -ENOMEM;
  88
  89         (*map)[*num_maps].type = type;
  90         (*map)[*num_maps].data.configs.group_or_pin = group;
  91         (*map)[*num_maps].data.configs.configs = dup_configs;
  92         (*map)[*num_maps].data.configs.num_configs = num_configs;
  93         (*num_maps)++;
  94
  95         return 0;
  96 }
  97 EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_configs);
  98
  99 int pinctrl_utils_add_config(struct pinctrl_dev *pctldev,
 100                 unsigned long **configs, unsigned *num_configs,
 101                 unsigned long config)
 102 {
 103         unsigned old_num = *num_configs;
 104         unsigned new_num = old_num + 1;
 105         unsigned long *new_configs;
 106
 107         new_configs = krealloc(*configs, sizeof(*new_configs) * new_num,
 108                                GFP_KERNEL);
 109         if (!new_configs) {
 110                 dev_err(pctldev->dev, "krealloc(configs) failed\n");
 111                 return -ENOMEM;
 112         }
 113
 114         new_configs[old_num] = config;
 115
 116         *configs = new_configs;
 117         *num_configs = new_num;
 118
 119         return 0;
 120 }
 121 EXPORT_SYMBOL_GPL(pinctrl_utils_add_config);
 122
 123 void pinctrl_utils_free_map(struct pinctrl_dev *pctldev,
 124               struct pinctrl_map *map, unsigned num_maps)
 125 {
 126         int i;
 127
 128         for (i = 0; i < num_maps; i++) {
 129                 switch (map[i].type) {
 130                 case PIN_MAP_TYPE_CONFIGS_GROUP:
 131                 case PIN_MAP_TYPE_CONFIGS_PIN:
 132                         kfree(map[i].data.configs.configs);
 133                         break;
 134                 default:
 135                         break;
 136                 }
 137         }
 138         kfree(map);
 139 }
 140 EXPORT_SYMBOL_GPL(pinctrl_utils_free_map);