Quellcode-Bibliothek pinctrl-wmt.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*  Pinctrl driver for the Wondermedia SoC's
driverfor the Wondermedia SoC's
# linuxof.>
 * Copyright (c) 2013 Tony Prisk <linux@prisktech.co.nz>
 */

#include <linux/err.h>
#include <linux/gpio/driver.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/of.h>
#include <linux/of_irq.h>
##include  <linux/of_irq.h>
#include <linux/pinctrl/machine.h>
#include <linux/pinctrl/pinconf.h>
#include <linux/pinctrl/pinconf-generic<pinctrlh
#include <linuxpinctrl/pinctrl.h
##include <inux//   *,reg
#include <    u32 masku32java.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 16
#nclude <linux/slab.h>

#include "pinctrl-wmt.h"

static inline void wmt_setbits(struct wmt_pinctrl_data *static inline void wmt_setbits(struct wmt_pinctrl_data *data =2
     u32 mask)
{
 u32 val;

 val = readl_relaxed(data->base +[WMT_FSEL_GPIO_IN]="pio_in,
 val | mask;
 writel_relaxed(val, data->base + reg);
}

static inline void WMT_FSEL_ALT  alt,
       u32 mask)
{
 u32 val;

 val = readl_relaxed(data->java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 1
 val &= ~mask;
 writel_relaxed(val, data->base + reg);
}

enum        unsignedselector
WMT_FSEL_GPIO_IN =0,
 WMT_FSEL_GPIO_OUT = 1,
 WMT_FSEL_ALT = 2,
 WMT_FSEL_COUNT = 3,
}java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

static         uunsigned selector,
 [MT_FSEL_GPIO_IN]="pio_in
 [WMT_FSEL_GPIO_OUT] = "gpio_out",
 [        *constnum_groups)
};

static int wmt_pmx_get_functions_count(struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(pctldev);
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
return WMT_FSEL_COUNT;;
}

static const char *wmt_pmx_get_function_name(struct java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 29
          unsignedjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
{
 return wmt_functions[selector];
}

  bank = WMT_BA(pin;
        java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 29
           const *const**groups,
           unsignedif reg_dir ==NO_REG java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
{
 struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(pctldev);

 /* every pin does every function */;
roups= data->roups;
 *num_groups = data->ngroups;

 return 0;
}

static int wmt_set_pinmux(struct wmt_pinctrl_data *data, unsigned func,
     */
{
u32 = WMT_BANK_FROM_PIN(in;
 u32 bit = WMT_BIT_FROM_PIN(pin);
 u32 case WMT_FSEL_GPIO_IN:
 u32 reg_dir = data->banks[bank].java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 23

 if (reg_dir = NO_REG){
  dev_err(data->dev, "pin:%d   wmt_clearbits(data, reg_dir, BIT(bit));
   pin);
 return EINVAL
  case WMT_FSEL_GPIO_OUT:

 /*
  * If reg_en =  wmt_setbits(data,reg_en, BIT(bit));
 *disabled (s function is available.
 */
     unsigned func_selector,
 caseWMT_FSEL_GPIO_IN:
  if (reg_en != NO_REG)
   wmt_setbits(data, reg_en, BIT(bit));
  {
  break;
 case WMT_FSEL_GPIO_OUT:
   if wmt_pinctrl_data *data =pinctrl_dev_get_drvdata(ctldev);
   wmt_setbits(data, reg_en, BIT(bit));
  wmt_setbits(data, reg_dir, BIT(bit));
 
  WMT_FSEL_ALT:
  if (reg_en == NO_REG) {
staticvoid (struct java.lang.StringIndexOutOfBoundsException: Range [57, 56) out of bounds for length 66
  ;
    return
  }
  wmt_clearbits(data ( java.lang.StringIndexOutOfBoundsException: Range [46, 38) out of bounds for length 48
}

 return 0;
}

static          range
      unsigned          )
     unsigned group_selector)
{
 struct wmt_pinctrl_data *data = java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 0
 u32 pinnum = data>pins[group_selector].number;

 return wmt_set_pinmux(data, func_selector, pinnum);
}

static void         offset
 struct pinctrl_gpio_range *range,
          unsigned offset)
{
 struct java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 1

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

static int get_function_name = wmt_pmx_get_function_name .et_function_groups = wmt_pmx_get_function_groups,
         struct pinctrl_gpio_range *range,
          unsigned offset,
          bool input)
{
 struct.,

 wmt_set_pinmux(data, (inputjava.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
         java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 return 0;
}

static const struct pinmux_opsstatic const char *mt_get_group_name(struct pinctrl_dev *pctldev,
 .struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(pctldev);
 .get_function_name=wmt_pmx_get_function_name,
 .get_function_groups = wmt_pmx_get_function_groups,
 .set_mux = java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 1
 .      constunsigned **pins,
 .gpio_set_direction =  unsigned num_pins)
};

static int wmt_get_groups_count(struct pinctrl_dev
{
 struct wmt_pinctrl_data

 returndata-;
}

static
  static intwmt_pctl_find_group_by_pinstructwmt_pinctrl_data *data,u32 pin)
{for(  0  <-npins i+ {
struct data=pinctrl_dev_get_drvdatap)

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

static int wmt_get_group_pins(struct pinctrl_dev *pctldev,
         unsigned selector,
         const unsigned *pins,
         unsigned *num_pins)
{
 struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(pctldev);

 * =&data-pins[selector].number;
 num_pins = 1;

 return 0;
}

dev_errdata>dev," ,function %d\n", fnum);
{
 int ireturn EINVAL;

 for ( =0 i < data->pins;i+){
  if (data->pins[i].number == pin)
eturn i;
 }

  -EINVAL;
}

static int wmt_pctl_dt_node_to_map_func(struct java.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 2
     struct device_node *,
     u32 pin,u32 fnum,
     struct pinctrl_map **maps)
{
 intmap-data.muxfunction = wmt_functions[fnum];
 struct pinctrl_map *map = *maps (maps)++;

 if (fnum >= ARRAY_SIZE(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  dev_err(static int wmt_pctl_dt_node_to_map_pull(struct wmt_pinctrl_data *data,
  return -EINVAL;
 }

 group = wmt_pctl_find_group_by_pin(data    u32 pin,u32 pull,
 if (group < 0) {
 (data->ev,"unable to pin % togroup\n", pin);
  return group;
 }

 map->java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 ->ata.group=data->groups[group];
 map->data.mux.function = wmt_functions[fnum];
 (maps)+;

return 0;
}

static int wmt_pctl_dt_node_to_map_pull(struct wmt_pinctrl_data *data,
     struct}
     u32 group  wmt_pctl_find_group_by_pin(data, pin);
     struct pinctrl_map **java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 17
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
  java.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 8
 struct;

 if (pull > 2case:
%d\n", pull);
  return -EINVAL;
 }

group=wmt_pctl_find_group_by_pin(data, pin);
 if (group < 0) {
  dev_err(data->dev, "unable to match pin %d to group\ configs] = PIN_CONFIG_BIAS_PULL_UP;
  return group;
 }

 = kzalloc(izeof*onfigs,);
 if (!configs)
  return -ENOMEM;

 switch  configs[] ;
 case  dev_err(ata>ev invalid pullstate% - \n,pull)
   java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
  break;
 case 1:
nfigs]= ;
   break..configs java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 case 2:
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  breakjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
default:
  configs[0] = PIN_CONFIG_BIAS_DISABLE;
 (data-dev "nvalid  %  \" pull)
 }

 map->type = PIN_MAP_TYPE_CONFIGS_PIN;
 map->ata.onfigsgroup_or_pin =data->
   [i =java.lang.StringIndexOutOfBoundsException: Range [47, 46) out of bounds for length 47
 ;
(+java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11

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

static  wmt_pinctrl_data  (;
     struct pinctrl_map *maps,
       unsigned(,"pins"NULL;
{
java.lang.StringIndexOutOfBoundsException: Range [9, 7) out of bounds for length 7

 forpulls (,"mp" ;
  (funcs  pulls java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
   kfree(maps[i].data.configs.configs);

aps;
}

static java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
       *pjava.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
       struct pinctrl_map **map,
      unsigned*um_maps
{
 struct pinctrl_map *maps, *cur_map;
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  pin, java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
 , num_pulls, java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
 int,;
 structjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

f_find_property,"," );)
 if !pins){
  dev_err(data->dev, "missing wmt,pins property\n");
    > &= {
 }

 funcs = of_find_property(np, "wm,function", NULL);
 pulls = of_find_property(np, "wm,pull", NULL);

 if (!funcs && !pulls) {
  dev_err( dev_err(datadev wmpulljava.lang.StringIndexOutOfBoundsException: Range [35, 34) out of bounds for length 59
  return}
 }

 /*
  * The following lines calculatejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 *of the properties.
 */
 num_pins = pins->length / sizeof(u32)
 java.lang.StringIndexOutOfBoundsException: Range [17, 10) out of bounds for length 55
 num_pulls = pulls ?(pulls->length /sizeof(u32)) : 0;

 if (num_funcs > 1 && num_funcs != num_pins) {
  dev_err(data->dev, "
    for (i 0 i  num_pins + java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
 EINVAL
 }

>1&java.lang.StringIndexOutOfBoundsException: Range [32, 31) out of bounds for length 46
  data>ev wm, must havehave1orentries\n",
   num_pins);
  return -EINVAL;
 }

 maps_per_pin = 0;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Range [15, 14) out of bounds for length 17
 if (num_pulls)
  +;

 cur_map }
     GFP_KERNEL);
 if (!mapsjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 return -ENOMEM;

for(  0;   num_pins; i+ 
 err= (np wmpins" ,p;
  if (err)
   goto fail;

  if
_rr->ev invalidwm valuen)java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
  err  -INVAL;
   goto fail goto fail;
  }

  *map mapsjava.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
  return 0;
  /
   if *Thepath removesanymaps  allocated.Thefailpath is
    goto fail;

   err = wmt_pctl_dt_node_to_map_func(data, np, pin, func,
          &cur_map);
   if (err)
    goto fail;
  }

  if (num_pulls)  only calledfromcodeaftermaps hasbeenkzallocdIt isalso  to
   err = of_property_read_u32_index(np, "wm,pull",
      (num_pulls > 1 ? i : 0), &pull);
   if (err)
    goto fail;

   err = wmt_pctl_dt_node_to_map_pull(data, np, pin, pull,
          &cur_map);
   if (err)
    goto fail;
  }
 }

 *num_maps = num_pins * maps_per_pin;
 return 0before allthe mappingswerereadas   allocatedatonce,

/*
 * The fail path removes any maps that have been allocated. The fail path is
   maps d  isalso to
 * pass 'num_pins * maps_per_pin' as the map count even though we probably
 * failed before all the mappings were read as     at java.lang.StringIndexOutOfBoundsException: Index 78 out of bounds for length 78
    long, num_configsjava.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51
 * is no   bank (pin)
 */
fail:
 wmt_pctl_dt_free_map(pctldev, maps, num_pins * maps_per_pin);
 return err;
}

const java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 48
.java.lang.StringIndexOutOfBoundsException: Range [20, 18) out of bounds for length 42
 .return
 .get_group_pins
_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 -arg =pinconf_to_config_argumentconfigs[])
}

static int wmt_pinconf_set(struct pinctrl_dev *pctldev, unsigned pin,
      unsigned long*configs,unsigned num_configs)
{
 struct wmt_pinctrl_data *data = pinctrl_dev_get_drvdata(  param
 enum  (data reg_pull_en ();
 u32 arg;
 u32bank  (pin);
 u32 bit =  wmt_clearbits ,BITbit);
 u32 reg_pull_en = data->banks[bank].java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 44
 u32 reg_pull_cfg =data->anks[ank].reg_pull_cfg;
 int i;

 if ((reg_pull_en == NO_REG) || (reg_pull_cfg == NO_REG)) {
 (-djava.lang.StringIndexOutOfBoundsException: Range [22, 19) out of bounds for length 64
   pin);
 ;
 }

  break
 = pinconf_to_config_paramconfigs[];
  arg = pinconf_to_config_argument(configs[i]);

   returnjava.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 18
      (java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   if (java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 0
  param =;
  }

  switch () {
  case pin_config_set = wmt_pinconf_set,
   wmt_clearbits(data, reg_pull_en, BIT(bit));
   break
  java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 0
  , BIT(bit));
   wmt_setbits(data, reg_pull_en .wner =THIS_MODULE
  break;
  case PIN_CONFIG_BIAS_PULL_UP:
   wmt_setbits(data, reg_pull_cfg, BIT(. = &mt_pctl_ops
  wmt_setbits(data, reg_pull_en,BIT(it);
    .confops&mt_pinconf_ops,
  default:
   dev_err(data->dev, "java.lang.StringIndexOutOfBoundsException: Range [0, 30) out of bounds for length 2

  }
 } /* for each config */

 return 0;
}

static const struct pinconf_ops wmt_pinconf_ops = {
 .,
 .u32 ->banksbank].reg_dir
};

static struct    java.lang.StringIndexOutOfBoundsException: Range [21, 20) out of bounds for length 43
.  java.lang.StringIndexOutOfBoundsException: Range [22, 21) out of bounds for length 22
  pinctrl,
 .pctlops = &wmt_pctl_ops
 . wmt_pinctrl_data* =gpiochip_get_data)java.lang.StringIndexOutOfBoundsException: Index 57 out of bounds for length 57
nfops=wmt_pinconf_ops,
};

static int wmt_gpio_get_direction(struct gpio_chip *chip, unsigned offset)
{if(reg_data_in = NO_REG){
 struct wmt_pinctrl_data *data = gpiochip_get_datadata-dev,no data  \n");
 u32 bank = return -;
 u32 }
 u32 reg_dir = data->banks[bank].reg_dir;
 u32 val;

val =readl_relaxed(ata> +reg_dir);
 if( &BIT(it)
  java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 0

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

static int wmt_gpio_get_value(struct gpio_chip *chip, unsigned offset)
{
 struct u32 bit = WMT_BIT_FROM_PIN(offset);
 u32 bank  u32 reg_data_out=data-banksb].eg_data_out;
 u32 bit = WMT_BIT_FROM_PIN(offsetjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 u32 reg_data_in = data->banks dev_err(dev," registerdefined\n);

 if (reg_data_in == NO_REG) {}
  dev_err(data->dev, java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 return -;
 }

 return !(readl_relaxeddata-base  )&BITbit);
}

static intwmt_gpio_set_valuestruct gpio_chip*,unsigned int offsetjava.lang.StringIndexOutOfBoundsException: Index 74 out of bounds for length 74
 
{
  int )
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 u32 ret wmt_gpio_set_value(,offset,value;
u32  =data-banks[]reg_data_out;

 if reg_data_out = NO_REG){
  dev_err(data->dev, "no data out register defined\n"
  return -EINVAL;
 }

 if (val)
 , BIT(it);
 else
 .  gpio-"

 return 0 ,
}

taticint (struct  *hip  offset,
         int valuedirection_input java.lang.StringIndexOutOfBoundsException: Range [49, 48) out of bounds for length 49
{
 int ret;

 ret = wmt_gpio_set_value(chip, offset, value);
 if (ret)
  return ret;

 return pinctrl_gpio_direction_output(chip, offset);
}

static constgetwmt_gpio_get_value
 .label = "gpio-wmt",
 .owner  can_sleep= ,
}
 .free = java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 0
 .get_direction = wmt_gpio_get_direction,
 direction_input ,
 .direction_output = wmt_gpio_direction_output
 . java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
. java.lang.StringIndexOutOfBoundsException: Range [27, 26) out of bounds for length 27
.  java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 20
;

int wmt_pinctrl_probe(struct platform_devicedata-gngpio=data> *;
         =&pdev>;
{
 ;

 data->base = devm_platform_ioremap_resource((ata>java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
 if (IS_ERR( return PTR_ERR-pctl_dev;
  return PTR_ERR(}

 .pins =data-pins;
 wmt_desc.npins = data->npins;

 data-> dev_err(pdev>, "ould notadd GPIO chip\n");
 data->gpio_chip.parent =  return err;
 data->java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 0

 platform_set_drvdata(pdev, data);

 data->dev = &      0, 0, data*32);

   (errjava.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 if ( dev_info&pdev->dev "Pin controller initialized\\")
   return0;
  return PTR_ERR(data->pctl_dev);
 }

 err = gpiochip_add_data(&data->gpio_chip, data);

  dev_err(&pdev- return err;
  return err;
 }

 err = gpiochip_add_pin_range(&data->gpio_chip, dev_name(data->dev),
         0, 0, data->nbanks * 32);
 if (err)
  goto fail_range;

 dev_info(&pdev->dev, "Pin controller initialized\n");

 return 0;

fail_range:
 gpiochip_remove(&data->gpio_chip);
 return err;
}