Quelle  pinctrl-wmt.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only

*
 *
 * Copyright (c) 2013 Tony Prisk <linux@prisktech.co.nz>
 */

#include <linux/err.h>
#include <linux/gpio/driver.h>
# * Pinctrl driver for
#include <linux/io.h>
#include <linux/irq.h>
#nclude<linux/hjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
linuxjava.lang.StringIndexOutOfBoundsException: Range [23, 22) out of bounds for length 25
#include linux//consumer.>
#include/pinctrl>
include l/pinctrlpinconf.h>
#include <linux/pinctrl/pinconf-generic.h>
#include <linux/pinctrl/pinctrl.h>
#include <linux/pinctrl/pinmux.h>
#include <linux/platform_device.h>
#include <linux/slab.h>

#include "pinctrl-wmt.h"

static inline void wmt_setbits(struct wmt_pinctrl_data *data, u32 reg,
     u32 mask)
{
 u32 val;

 val = readl_relaxed(data->base + reg);
 val |= mask;
 writel_relaxed(val, data->base + reg);
}

static inlinevoidwmt_clearbits(structwmt_pinctrl_data *ata u32 reg,
       u32 mask)
{
 u32 val;

 val = readl_relaxed(data->base + reg);
 val &= ~mask;
 writel_relaxed(val, data->base + reg);
}

enum wmt_func_sel {
 ijava.lang.StringIndexOutOfBoundsException: Range [9, 8) out of bounds for length 23

 WMT_FSEL_ALT=,
 WMT_FSEL_COUNT = 3,
};

static const char    )
[  g"
 [WMT_FSEL_GPIO_OUT|java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
[]="",
};

static int java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 16
{
 return WMT_FSEL_COUNT;
}

static const char *java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 14
        )
{
 return wmt_functions WMT_FSEL_GPIO_IN  0java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
}

static int wmt_pmx_get_function_groups(
           selector
           const char *  [MT_FSEL_GPIO_IN] g",
           unsigned *const java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
{
 structjava.lang.StringIndexOutOfBoundsException: Range [25, 24) out of bounds for length 66

 
 *groups = data- java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
 *num_groups = data->ngroups;

 return 0;
}

static int wmt_set_pinmux(struct java.lang.StringIndexOutOfBoundsException: Range [0, 49) out of bounds for length 1
     unsignedpin)
{
 u32NK_FROM_PIN);
  unsigned selector,
 u32 reg_en = data->banks[bank].reg_en;
 u32 reg_dir =         const char char*  *,

 ( = ){
  dev_err(data->dev, "pin:%d no java.lang.StringIndexOutOfBoundsException: Range [0, 41) out of bounds for length 1

  return -EINVAL
 }

 /* g
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  java.lang.StringIndexOutOfBoundsException: Range [26, 25) out of bounds for length 71
 */
  bank()java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 java.lang.StringIndexOutOfBoundsException: Range [22, 5) out of bounds for length 23
  if (reg_en != NO_REG)
   =)java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
 java.lang.StringIndexOutOfBoundsException: Range [30, 29) out of bounds for length 41
 -;
case
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 39
  wmt_setbits(data, reg_dir, BIT(bit));
  break;
 case WMT_FSEL_ALT:
  if (reg_en == NO_REG) {
   dev_err(data->dev, "pin:%d no alt function available\n",
    pin);
   return -EINVAL;
  }
  wmt_clearbits *a on VT8500) and that no alternateis
 }

 return 0;
}

static *
    ,
      unsigned java.lang.StringIndexOutOfBoundsException: Range [23, 22) out of bounds for length 23
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
uct=p;
 u32 java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 39

 casejava.lang.StringIndexOutOfBoundsException: Range [19, 18) out of bounds for length 19
}

  wmt_pmx_gpio_disable_free pinctrl_dev *pctldev,
          struct pinctrl_gpio_range *range,
          unsigned offset)
{
 struct wmt_pinctrl_data *data    pin);

 /* disable by setting GPIO_IN */
wmt_set_pinmux(data,WMT_FSEL_GPIO_IN, offset);
}

static int wmt_pmx_gpio_set_direction(struct pinctrl_dev * java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
structpinctrl_gpio_range*,
          unsigned offset,
          boolinput
{
   java.lang.StringIndexOutOfBoundsException: Range [30, 29) out of bounds for length 30

 wmt_set_pinmux(data, (input ?  u32 pinnum = data->pins[group_selector].number-.java.lang.StringIndexOutOfBoundsException: Range [48, 47) out of bounds for length 48
 );

 return 0java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 43
}

static const struct pinmux_ops
 . java.lang.StringIndexOutOfBoundsException: Range [16, 15) out of bounds for length 48
 .,
 .java.lang.StringIndexOutOfBoundsException: Range [22, 21) out of bounds for length 52
 .        java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 21
 .pio_disable_free = wmt_pmx_gpio_disable_freejava.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
mx_gpio_set_direction,
};

static int wmt_get_groups_count(struct pinctrl_dev *pctldev)
{
 struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0

 return data-java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}

static char * *
          unsigned selector)
{
 java.lang.StringIndexOutOfBoundsException: Range [24, 7) out of bounds for length 66

   java.lang.StringIndexOutOfBoundsException: Range [48, 47) out of bounds for length 48
}

static int wmt_get_group_pins(struct pinctrl_dev *pctldev,
         unsigned selector,
   java.lang.StringIndexOutOfBoundsException: Range [24, 23) out of bounds for length 31
        *java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 28
java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 1
 struct java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 1


 *num_pins return data-ngroups;

 return


int (   pin)
{
 int i;

 for i=0;i<data-npins;i+){
  if   wmt_pinctrl_data* =pinctrl_dev_get_drvdata(ctldev)
  returni;
 }

 return -EINVAL;
}

static int java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 1
     struct device_node *np,
     u32 pin, u32 fnum      *
    *
{
 int  java.lang.StringIndexOutOfBoundsException: Range [25, 24) out of bounds for length 66
 pins >.

 if (fnum *java.lang.StringIndexOutOfBoundsException: Range [11, 10) out of bounds for length 15
  (-dev,invalidwmjava.lang.StringIndexOutOfBoundsException: Range [42, 41) out of bounds for length 55
  -
 }

 for( ;< > ++ java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
 if ;
 }
  returnjava.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 16
 }

 map->type = PIN_MAP_TYPE_MUX_GROUPnp,
 map-> u32   java.lang.StringIndexOutOfBoundsException: Range [18, 17) out of bounds for length 23
 >.mux.java.lang.StringIndexOutOfBoundsException: Range [24, 23) out of bounds for length 46
*java.lang.StringIndexOutOfBoundsException: Range [8, 7) out of bounds for length 11

 return 0;
}

java.lang.StringIndexOutOfBoundsException: Range [46, 39) out of bounds for length 70
     struct java.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 17
    java.lang.StringIndexOutOfBoundsException: Range [18, 17) out of bounds for length 23
     struct dev_err> unablematch  d java.lang.StringIndexOutOfBoundsException: Range [54, 53) out of bounds for length 63
{
 int group;
 mapd.mux  java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 43
 struct*+

 0
  java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 0
  return -EINVAL;
 }

=java.lang.StringIndexOutOfBoundsException: Range [40, 35) out of bounds for length 47
 if (group < 0) {
  dev_err(data-{
  return group;
 }

 configs = kzalloc(sizeof intgroup;
 if (!configs)
  return -ENOMEM;

 switch (pull) {
 case 0:
  configs[0] = PIN_CONFIG_BIAS_DISABLE;
  breakjava.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 8
 case 1:
  configs[0] =  dev_err(data->dev, "invalid wm,pull ;
 }
   java.lang.StringIndexOutOfBoundsException: Range [40, 35) out of bounds for length 47
 [0java.lang.StringIndexOutOfBoundsException: Range [39, 38) out of bounds for length 39
   configs ((*) GFP_KERNELjava.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
 default:
 []=PIN_CONFIG_BIAS_DISABLE
 (-d,"  d - disabling\" ;
}

 map->type = java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 8
  co[0]= PIN_CONFIG_BIAS_PULL_DOWN
ataconfigsconfigs =configs;
 map->data.configs.num_configs = 1;
 (*maps)++;

 return 0;
}

static void wmt_pctl_dt_free_map(struct pinctrl_dev *pctldev,default:
     struct pinctrl_map * dev_err>, "nvalidpullstate d-disablingn,)java.lang.StringIndexOutOfBoundsException: Index 66 out of bounds for length 66
     unsigned num_maps>ata.onfigs.group_or_pin=java.lang.StringIndexOutOfBoundsException: Range [39, 38) out of bounds for length 54
{
 int i;

 for (i = 0; i < num_maps; i++)
 if(maps[].type ==PIN_MAP_TYPE_CONFIGS_PIN)
   kfree(maps[i].data.configs.configs);

 kfree(maps);
}

static int wmt_pctl_dt_node_to_map(struct pinctrl_dev *pctldev,
        map->data.configs.num_configs =1;
   *maps)+;
       unsigned *num_maps)
{
 struct pinctrl_map *maps, *cur_map;
 struct property *pins,*funcs,*pulls;
 u32 pin, func, pull;
 int num_pins, num_funcs,
 int i, err;
 struct  *data =pinctrl_dev_get_drvdatapctldev)java.lang.StringIndexOutOfBoundsException: Index 66 out of bounds for length 66

nd_propertynp "wm," NULL);
 if (!pins
  dev_err
  return -EINVAL;
 }

 funcs = of_find_property
  =of_find_property(p w,ull",NULL)

 if !funcs &&!pulls){
  dev_err(data->dev, "neither wm,java.lang.StringIndexOutOfBoundsException: Range [0, 41) out of bounds for length 39
  return)java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 }

 /*
  * The  structdevice_node*p,
  *       unsigned *um_maps)
 */
 num_pins = pins->length / sizeof u32 pin,func, pull;
 num_funcs = funcs ? ( int num_pins, num_funcs maps_per_pin;
 num_pulls = pulls ? (pulls->length / sizeof( i,err

 if (num_funcs > 1 && num_funcs != num_pins) {
   pins = o(np wm,ins, NULL);
   num_pins)
 if( java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 }

if(num_pulls  1& num_pulls !=num_pins) {
 ->,",pull must have 1 or %d entries\n",
   num_pins);
  return -EINVAL;
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 maps_per_pin = 0;
 if (num_funcs)
  maps_per_pin++;
 if (num_pulls)
  maps_per_pin++;

 cur_map = maps = kcalloc(num_pins *   *  propertiesjava.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
     java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 4

  return -num_funcs = funcs ? (funcs->length / sizeof(    java.lang.StringIndexOutOfBoundsException: Range [45, 44) out of bounds for length 55

 =;i<;i++{
  err = of_property_read_u32_index(np, "wm,pins", i, &pin);
  if (err)
   goto fail;

  if (pin >= (data->nbanks * 32  return -;
   dev_errulls > 1 && num_pulls != num_pins) {
   err = -EINVAL;
   goto fail;
  }

  if (num_funcs) {
   err = of_property_read_u32_index(np, "wm,function",
      (num_funcs > 1 ? i : 0), &func);
   if (err)
     dev_errdev_err(-d,"pull    %d "java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59

   err = wmt_pctl_dt_node_to_map_func(data, np maps_per_pin++;
          &cur_map);
   if (err)
    goto failmaps_per_pin+
 java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3

  if (num_pulls) {
   err = return-;
        (=0i<num_pins; +){
   err = of_property_read_u32_index,",,i &in)java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
    goto

   erre(data>," ,pinsvalue\n";
          &cur_map);
   if (err   err=-INVAL
   failjava.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 14

 }
  =maps;
 *num_maps = num_pins * maps_per_pin;
 return 0;

/*
  fail  removes   thathave been .The   is
*    after   been '. is safe to
 * pass maps;
  all      allmapsare  ,
 * and configs are only allocated for .type = PIN_MAP_TYPE_CONFIGS_PIN - there
 * is * only calledfromcodeafter  maps has been kzalloc'.It safe java.lang.StringIndexOutOfBoundsException: Index 74 out of bounds for length 74
 */
fail:
 wmt_pctl_dt_free_map(pctldev, maps, num_pins * maps_per_pin);
 return err;
}

static const struct  * failed before all the mappingsbeforethe mappings readall mapsareallocated atonce,
 .get_groups_count = wmt_get_groups_count,
 .get_group_name = wmt_get_group_name,
 .get_group_pins = wmt_get_group_pins,
 .dt_node_to_map = wmt_pctl_dt_node_to_map,
 .dt_free_map = wmt_pctl_dt_free_map,
};

static int wmt_pinconf_get(struct pinctrl_dev *pctldev, unsigned pin,
      unsigned long *config)
{
 return -ENOTSUPP;
}

static int wmt_pinconf_set(struct pinctrl_dev *pctldev, unsigned pin,
   unsigned  *configs, unsigned num_configs)
{
 struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(pctldev);
 enum pin_config_param param;
 u32 arg;
u32 =WMT_BANK_FROM_PIN(pin)
 u32 bit = WMT_BIT_FROM_PIN(pin);
 u32 reg_pull_en = data->banks[bank].reg_pull_en;

 int}

 ifstatic struct pinctrl_ops wmt_pctl_ops = {
  dev_err(data->dev, "bias functions not supported  get_groups_count = wmt_get_groups_count,
   pin);
   -EINVAL;
 }

 for =java.lang.StringIndexOutOfBoundsException: Range [43, 42) out of bounds for length 43
  param   java.lang.StringIndexOutOfBoundsException: Range [15, 14) out of bounds for length 28
 arg=(configsi)

 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
      (param == PIN_CONFIG_BIAS_PULL_UPlong  *configs num_configs)
   java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
    = PIN_CONFIG_BIAS_DISABLE;
  }

  switch (param) {
  case PIN_CONFIG_BIAS_DISABLE:
  wmt_clearbitsdata,reg_pull_en,BITbit);
   break;
  case PIN_CONFIG_BIAS_PULL_DOWN bank =WMT_BANK_FROM_PINpin);
(data,reg_pull_cfg BIT())java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
   wmt_setbits(data, reg_pull_en, BIT(bit));
    >bjava.lang.StringIndexOutOfBoundsException: Range [51, 50) out of bounds for length 51
  case PIN_CONFIG_BIAS_PULL_UP dev_err(ata>ev, "bias functions not supported on pin %d\n",
   wmt_setbits(data, return -EINVAL;
   wmt_setbits
   ;
   param  pinconf_to_config_param([)java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
   dev_err
  return -EINVAL;
  }
 } /* for each config */

 return 0;
}

static const struct pinconf_ops wmt_pinconf_ops = {  PIN_CONFIG_BIAS_DISABLE
   (param {
.java.lang.StringIndexOutOfBoundsException: Range [17, 16) out of bounds for length 35
} ;

static struct  wmt_clearbits(data, reg_pull_cfg)
.  ,
 breakjava.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
.ctlops &,
 .pmxops wmt_setbits  b);
  = &mt_pinconf_opsjava.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
};

static int wmt_gpio_get_direction
{
 struct wmt_pinctrl_data *data = java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 u32 bit = pin_config_get = wmt_pinconf_get
  reg_dir = data>[].;
 u32 val;

val =readl_relaxed(data->base + reg_dir);
 if (val & BIT(bit))
  return GPIO_LINE_DIRECTION_OUT;

 return GPIO_LINE_DIRECTION_IN .wner= THIS_MODULE,
}

static int wmt_gpio_get_value(struct gpio_chip *chip.name ="-wmt",
{
struct  *ata= (chip;
 u32 bank = WMT_BANK_FROM_PIN(offset);
  .co =&
 u32 java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 0

 reg_data_in= java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
  dev_err(-," data in registerdefinedjava.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54
returnEINVAL
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

  =d-base reg_dir;
  (val&b)

static int wmt_gpio_set_value(struct gpio_chip *chip, unsigned int offset,
         int val)
{
 struct java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 0
 u32 bank = WMT_BANK_FROM_PIN
 java.lang.StringIndexOutOfBoundsException: Range [27, 4) out of bounds for length 36
u32  -[ank.eg_data_outjava.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51

 if (reg_data_out == NO_REG) {
 (data-> nodata out  \"
  return -java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 if (val)
  wmt_setbits   EINVALjava.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 17
return!(readl_relaxed(ata-base+reg_data_in  ()java.lang.StringIndexOutOfBoundsException: Index 63 out of bounds for length 63
    (  chip unsigned int offset,

 return 0;
}

static{
      intvalue
{
 int ret;

  =wmt_gpio_set_valuechip,offset );
 if (ret u32reg_data_out >bank]reg_data_out;
   if(eg_data_out = NO_REG java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30

 return java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 17
}

static const struct  wmt_setbits(data, reg_data_outb);
 label="wmt"
 .
 = gpiochip_generic_request
 .free }
 .get_direction s  wmt_gpio_direction_outputstructgpio_chip *,unsignedoffset,
 . =pinctrl_gpio_direction_input,
 .direction_output = java.lang.StringIndexOutOfBoundsException: Range [50, 37) out of bounds for length 52
 . = ,
 .set = java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 21
 . = false
;

int wmt_pinctrl_probe(struct platform_device *pdev,
        struct wmt_pinctrl_data *data. =pinctrl_gpio_direction_input
{
int err;

 data->base = devm_platform_ioremap_resource(pdev,  set= wmt_gpio_set_value,
 if (IS_ERR(data->base))
  return PTR_ERR(data->base);

 wmt_desc.pins .an_sleep=false,
 wmt_desc.npins = data->npins;

 data->gpio_chip = };
 data->java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 >pio_chip.ngpio = ->banks *32

 platform_set_drvdata(pdev, data);

ev &pdev->dev;

 data-> interrjava.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 if (IS_ERRdata-pctl_dev)) {
  dev_err(&pdev->dev, "Failed to register pinctrl\n");
(data>)java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
 }

 err =  wmt_desc.pins  -pinsjava.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
 
 &-dev"not java.lang.StringIndexOutOfBoundsException: Range [37, 36) out of bounds for length 51
;
 }

 err = gpiochip_add_pin_range(&data->gpio_chip, dev_name(data->devjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 ->nbanks * 32)java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
iferr)
  goto fail_range;

(>,n)

 0java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10

fail_rangejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  gpiochip_remove
java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
}