Branch data     Line data    Source code

       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                 :          0 : 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                 :          0 :         unsigned old_num = *reserved_maps;
      36                 :          0 :         unsigned new_num = *num_maps + reserve;
      37                 :            :         struct pinctrl_map *new_map;
      38                 :            : 
      39         [ #  # ]:          0 :         if (old_num >= new_num)
      40                 :            :                 return 0;
      41                 :            : 
      42                 :          0 :         new_map = krealloc(*map, sizeof(*new_map) * new_num, GFP_KERNEL);
      43         [ #  # ]:          0 :         if (!new_map) {
      44                 :          0 :                 dev_err(pctldev->dev, "krealloc(map) failed\n");
      45                 :          0 :                 return -ENOMEM;
      46                 :            :         }
      47                 :            : 
      48                 :          0 :         memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map));
      49                 :            : 
      50                 :          0 :         *map = new_map;
      51                 :          0 :         *reserved_maps = new_num;
      52                 :          0 :         return 0;
      53                 :            : }
      54                 :            : EXPORT_SYMBOL_GPL(pinctrl_utils_reserve_map);
      55                 :            : 
      56                 :          0 : 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   [ #  #  #  # ]:          0 :         if (WARN_ON(*num_maps == *reserved_maps))
      62                 :            :                 return -ENOSPC;
      63                 :            : 
      64                 :          0 :         (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
      65                 :          0 :         (*map)[*num_maps].data.mux.group = group;
      66                 :          0 :         (*map)[*num_maps].data.mux.function = function;
      67                 :          0 :         (*num_maps)++;
      68                 :            : 
      69                 :          0 :         return 0;
      70                 :            : }
      71                 :            : EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_mux);
      72                 :            : 
      73                 :          0 : 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   [ #  #  #  # ]:          0 :         if (WARN_ON(*num_maps == *reserved_maps))
      82                 :            :                 return -ENOSPC;
      83                 :            : 
      84                 :          0 :         dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs),
      85                 :            :                               GFP_KERNEL);
      86         [ #  # ]:          0 :         if (!dup_configs)
      87                 :            :                 return -ENOMEM;
      88                 :            : 
      89                 :          0 :         (*map)[*num_maps].type = type;
      90                 :          0 :         (*map)[*num_maps].data.configs.group_or_pin = group;
      91                 :          0 :         (*map)[*num_maps].data.configs.configs = dup_configs;
      92                 :          0 :         (*map)[*num_maps].data.configs.num_configs = num_configs;
      93                 :          0 :         (*num_maps)++;
      94                 :            : 
      95                 :          0 :         return 0;
      96                 :            : }
      97                 :            : EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_configs);
      98                 :            : 
      99                 :          0 : int pinctrl_utils_add_config(struct pinctrl_dev *pctldev,
     100                 :            :                 unsigned long **configs, unsigned *num_configs,
     101                 :            :                 unsigned long config)
     102                 :            : {
     103                 :          0 :         unsigned old_num = *num_configs;
     104                 :          0 :         unsigned new_num = old_num + 1;
     105                 :            :         unsigned long *new_configs;
     106                 :            : 
     107                 :          0 :         new_configs = krealloc(*configs, sizeof(*new_configs) * new_num,
     108                 :            :                                GFP_KERNEL);
     109         [ #  # ]:          0 :         if (!new_configs) {
     110                 :          0 :                 dev_err(pctldev->dev, "krealloc(configs) failed\n");
     111                 :          0 :                 return -ENOMEM;
     112                 :            :         }
     113                 :            : 
     114                 :          0 :         new_configs[old_num] = config;
     115                 :            : 
     116                 :          0 :         *configs = new_configs;
     117                 :          0 :         *num_configs = new_num;
     118                 :            : 
     119                 :          0 :         return 0;
     120                 :            : }
     121                 :            : EXPORT_SYMBOL_GPL(pinctrl_utils_add_config);
     122                 :            : 
     123                 :          0 : void pinctrl_utils_free_map(struct pinctrl_dev *pctldev,
     124                 :            :               struct pinctrl_map *map, unsigned num_maps)
     125                 :            : {
     126                 :            :         int i;
     127                 :            : 
     128         [ #  # ]:          0 :         for (i = 0; i < num_maps; i++) {
     129         [ #  # ]:          0 :                 switch (map[i].type) {
     130                 :            :                 case PIN_MAP_TYPE_CONFIGS_GROUP:
     131                 :            :                 case PIN_MAP_TYPE_CONFIGS_PIN:
     132                 :          0 :                         kfree(map[i].data.configs.configs);
     133                 :          0 :                         break;
     134                 :            :                 default:
     135                 :            :                         break;
     136                 :            :                 }
     137                 :            :         }
     138                 :          0 :         kfree(map);
     139                 :          0 : }
     140                 :            : EXPORT_SYMBOL_GPL(pinctrl_utils_free_map);