Commit | Line | Data |
---|---|---|
e634cf4e | 1 | // SPDX-License-Identifier: GPL-2.0-only |
1eb207a9 LD |
2 | /* |
3 | * Utils functions to implement the pincontrol driver. | |
4 | * | |
5 | * Copyright (c) 2013, NVIDIA Corporation. | |
6 | * | |
7 | * Author: Laxman Dewangan <ldewangan@nvidia.com> | |
1eb207a9 LD |
8 | */ |
9 | #include <linux/device.h> | |
2f62eb9d | 10 | #include <linux/export.h> |
1eb207a9 LD |
11 | #include <linux/kernel.h> |
12 | #include <linux/pinctrl/pinctrl.h> | |
13 | #include <linux/of.h> | |
14 | #include <linux/slab.h> | |
15 | #include "core.h" | |
16 | #include "pinctrl-utils.h" | |
17 | ||
18 | int pinctrl_utils_reserve_map(struct pinctrl_dev *pctldev, | |
19 | struct pinctrl_map **map, unsigned *reserved_maps, | |
20 | unsigned *num_maps, unsigned reserve) | |
21 | { | |
22 | unsigned old_num = *reserved_maps; | |
23 | unsigned new_num = *num_maps + reserve; | |
24 | struct pinctrl_map *new_map; | |
25 | ||
26 | if (old_num >= new_num) | |
27 | return 0; | |
28 | ||
2207994d | 29 | new_map = krealloc_array(*map, new_num, sizeof(*new_map), GFP_KERNEL); |
1eb207a9 LD |
30 | if (!new_map) { |
31 | dev_err(pctldev->dev, "krealloc(map) failed\n"); | |
32 | return -ENOMEM; | |
33 | } | |
34 | ||
35 | memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map)); | |
36 | ||
37 | *map = new_map; | |
38 | *reserved_maps = new_num; | |
39 | return 0; | |
40 | } | |
41 | EXPORT_SYMBOL_GPL(pinctrl_utils_reserve_map); | |
42 | ||
43 | int pinctrl_utils_add_map_mux(struct pinctrl_dev *pctldev, | |
44 | struct pinctrl_map **map, unsigned *reserved_maps, | |
45 | unsigned *num_maps, const char *group, | |
46 | const char *function) | |
47 | { | |
48 | if (WARN_ON(*num_maps == *reserved_maps)) | |
49 | return -ENOSPC; | |
50 | ||
51 | (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP; | |
52 | (*map)[*num_maps].data.mux.group = group; | |
53 | (*map)[*num_maps].data.mux.function = function; | |
54 | (*num_maps)++; | |
55 | ||
56 | return 0; | |
57 | } | |
58 | EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_mux); | |
59 | ||
60 | int pinctrl_utils_add_map_configs(struct pinctrl_dev *pctldev, | |
61 | struct pinctrl_map **map, unsigned *reserved_maps, | |
62 | unsigned *num_maps, const char *group, | |
63 | unsigned long *configs, unsigned num_configs, | |
64 | enum pinctrl_map_type type) | |
65 | { | |
66 | unsigned long *dup_configs; | |
67 | ||
68 | if (WARN_ON(*num_maps == *reserved_maps)) | |
69 | return -ENOSPC; | |
70 | ||
71 | dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs), | |
72 | GFP_KERNEL); | |
86f75c65 | 73 | if (!dup_configs) |
1eb207a9 | 74 | return -ENOMEM; |
1eb207a9 LD |
75 | |
76 | (*map)[*num_maps].type = type; | |
77 | (*map)[*num_maps].data.configs.group_or_pin = group; | |
78 | (*map)[*num_maps].data.configs.configs = dup_configs; | |
79 | (*map)[*num_maps].data.configs.num_configs = num_configs; | |
80 | (*num_maps)++; | |
81 | ||
82 | return 0; | |
83 | } | |
84 | EXPORT_SYMBOL_GPL(pinctrl_utils_add_map_configs); | |
85 | ||
86 | int pinctrl_utils_add_config(struct pinctrl_dev *pctldev, | |
87 | unsigned long **configs, unsigned *num_configs, | |
88 | unsigned long config) | |
89 | { | |
90 | unsigned old_num = *num_configs; | |
91 | unsigned new_num = old_num + 1; | |
92 | unsigned long *new_configs; | |
93 | ||
94 | new_configs = krealloc(*configs, sizeof(*new_configs) * new_num, | |
95 | GFP_KERNEL); | |
96 | if (!new_configs) { | |
97 | dev_err(pctldev->dev, "krealloc(configs) failed\n"); | |
98 | return -ENOMEM; | |
99 | } | |
100 | ||
101 | new_configs[old_num] = config; | |
102 | ||
103 | *configs = new_configs; | |
104 | *num_configs = new_num; | |
105 | ||
106 | return 0; | |
107 | } | |
108 | EXPORT_SYMBOL_GPL(pinctrl_utils_add_config); | |
109 | ||
d32f7fd3 | 110 | void pinctrl_utils_free_map(struct pinctrl_dev *pctldev, |
1eb207a9 LD |
111 | struct pinctrl_map *map, unsigned num_maps) |
112 | { | |
113 | int i; | |
114 | ||
3287c240 LD |
115 | for (i = 0; i < num_maps; i++) { |
116 | switch (map[i].type) { | |
117 | case PIN_MAP_TYPE_CONFIGS_GROUP: | |
118 | case PIN_MAP_TYPE_CONFIGS_PIN: | |
1eb207a9 | 119 | kfree(map[i].data.configs.configs); |
3287c240 LD |
120 | break; |
121 | default: | |
122 | break; | |
123 | } | |
124 | } | |
1eb207a9 LD |
125 | kfree(map); |
126 | } | |
d32f7fd3 | 127 | EXPORT_SYMBOL_GPL(pinctrl_utils_free_map); |