Fri, Aug 04, 2023 at 11:46:00AM +0100, Charles Keepax kirjoitti:
The CS42L43 is an audio CODEC with integrated MIPI SoundWire interface (Version 1.2.1 compliant), I2C, SPI, and I2S/TDM interfaces designed for portable applications. It provides a high dynamic range, stereo DAC for headphone output, two integrated Class D amplifiers for loudspeakers, and two ADCs for wired headset microphone input or stereo line input. PDM inputs are provided for digital microphones.
Add a basic pinctrl driver which supports driver strength for the various pins, gpios, and pinmux for the 2 multi-function pins.
GPIOs
...
+ array_size.h
+#include <linux/module.h> +#include <linux/of.h>
+ types.h
...
+static int cs42l43_pin_set_mux(struct pinctrl_dev *pctldev,
unsigned int func_idx, unsigned int group_idx)+{
- struct cs42l43_pin *priv = pinctrl_dev_get_drvdata(pctldev);
- unsigned int reg, mask, val;
- dev_dbg(priv->dev, "Setting %s to %s\n",
cs42l43_pin_groups[group_idx].name, cs42l43_pin_funcs[func_idx]);- switch (func_idx) {
- case CS42L43_FUNC_MIC_SHT:
reg = CS42L43_SHUTTER_CONTROL;mask = CS42L43_MIC_SHUTTER_CFG_MASK;val = 0x2 << (group_idx + CS42L43_MIC_SHUTTER_CFG_SHIFT);
BIT(1) ?
break;- case CS42L43_FUNC_SPK_SHT:
reg = CS42L43_SHUTTER_CONTROL;mask = CS42L43_SPK_SHUTTER_CFG_MASK;val = 0x2 << (group_idx + CS42L43_SPK_SHUTTER_CFG_SHIFT);
Ditto.
break;- default:
reg = CS42L43_GPIO_FN_SEL;mask = BIT(group_idx + CS42L43_GPIO1_FN_SEL_SHIFT);val = (func_idx == CS42L43_FUNC_GPIO) ?(0x1 << (group_idx + CS42L43_GPIO1_FN_SEL_SHIFT)) : 0;
BIT(0) ?
break;- }
- if (priv->shutters_locked && reg == CS42L43_SHUTTER_CONTROL) {
dev_err(priv->dev, "Shutter configuration not available\n");return -EPERM;- }
- return regmap_update_bits(priv->regmap, reg, mask, val);
+}
...
+static int cs42l43_gpio_set_direction(struct pinctrl_dev *pctldev,
struct pinctrl_gpio_range *range,unsigned int offset, bool input)+{
- struct cs42l43_pin *priv = pinctrl_dev_get_drvdata(pctldev);
- unsigned int shift = offset + CS42L43_GPIO1_DIR_SHIFT;
- int ret;
- dev_dbg(priv->dev, "Setting gpio%d to %s\n",
offset + 1, input ? "input" : "output");
Probably candidate for str_input_output() in string_choises.h...
- ret = pm_runtime_resume_and_get(priv->dev);
- if (ret) {
dev_err(priv->dev, "Failed to resume for direction: %d\n", ret);return ret;- }
- ret = regmap_update_bits(priv->regmap, CS42L43_GPIO_CTRL1,
BIT(shift), !!input << shift);- if (ret)
dev_err(priv->dev, "Failed to set gpio%d direction: %d\n",offset + 1, ret);
- pm_runtime_put(priv->dev);
Can't runtime PM be put before printing message (if needed)?
- return ret;
+}
...
+static inline int cs42l43_pin_set_drv_str(struct cs42l43_pin *priv, unsigned int pin,
unsigned int ma)+{
- const struct cs42l43_pin_data *pdat = cs42l43_pin_pins[pin].drv_data;
- int i;
- for (i = 0; i < ARRAY_SIZE(cs42l43_pin_drv_str_ma); i++) {
if (ma == cs42l43_pin_drv_str_ma[i]) {
if (ma != ...) continue;
and one level of indentation less with better readability of the code, no?
if ((i << pdat->shift) > pdat->mask)goto err;dev_dbg(priv->dev, "Set drive strength for %s to %d mA\n",cs42l43_pin_pins[pin].name, ma);return regmap_update_bits(priv->regmap, pdat->reg,pdat->mask, i << pdat->shift);}- }
+err:
- dev_err(priv->dev, "Invalid drive strength for %s: %d mA\n",
cs42l43_pin_pins[pin].name, ma);- return -EINVAL;
+}
...
+static inline int cs42l43_pin_get_db(struct cs42l43_pin *priv, unsigned int pin)
Here and elsewhere these 'inline':s are redundant. Let compiler decide.
...
- dev_dbg(priv->dev, "Set debounce %s for %s\n",
str_on_off(us), cs42l43_pin_pins[pin].name);
Probably you wanted to include string_choices.h instead of string_helpers.h?
...
- dev_dbg(priv->dev, "Setting gpio%d to %s\n",
offset + 1, value ? "high" : "low");
str_high_low()
...
+static int cs42l43_pin_probe(struct platform_device *pdev) +{
struct device *dev = &pdev->dev;
will help to make code neater.
- struct cs42l43 *cs42l43 = dev_get_drvdata(pdev->dev.parent);
- struct cs42l43_pin *priv;
- struct pinctrl_dev *pctldev;
- struct fwnode_handle *fwnode = dev_fwnode(cs42l43->dev);
- int ret;
- priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
return -ENOMEM;- priv->dev = &pdev->dev;
- priv->regmap = cs42l43->regmap;
- priv->shutters_locked = cs42l43->hw_lock;
- priv->gpio_chip.request = gpiochip_generic_request;
- priv->gpio_chip.free = gpiochip_generic_free;
- priv->gpio_chip.direction_input = cs42l43_gpio_direction_in;
- priv->gpio_chip.direction_output = cs42l43_gpio_direction_out;
- priv->gpio_chip.add_pin_ranges = cs42l43_gpio_add_pin_ranges;
- priv->gpio_chip.get = cs42l43_gpio_get;
- priv->gpio_chip.set = cs42l43_gpio_set;
- priv->gpio_chip.label = dev_name(priv->dev);
- priv->gpio_chip.parent = priv->dev;
- priv->gpio_chip.can_sleep = true;
- priv->gpio_chip.base = -1;
- priv->gpio_chip.ngpio = CS42L43_NUM_GPIOS;
...
- if (is_of_node(fwnode)) {
fwnode = fwnode_get_named_child_node(fwnode, "pinctrl");if (fwnode && !fwnode->dev)fwnode->dev = priv->dev;- }
What the heck is this? Why devlink field is set customly here? Please, figure out how to get rid of this (it should be either global solution via devlink or pin control, individual drivers must not even touch devlink fwnode fields without a huge reason why.
- priv->gpio_chip.fwnode = fwnode;
- device_set_node(priv->dev, fwnode);
- devm_pm_runtime_enable(priv->dev);
- pm_runtime_idle(priv->dev);
- pctldev = devm_pinctrl_register(priv->dev, &cs42l43_pin_desc, priv);
- if (IS_ERR(pctldev))
return dev_err_probe(priv->dev, PTR_ERR(pctldev),"Failed to register pinctrl\n");- ret = devm_gpiochip_add_data(priv->dev, &priv->gpio_chip, priv);
- if (ret)
return dev_err_probe(priv->dev, ret,"Failed to register gpiochip\n");- return 0;
+}