Quelle  tps68470_pmic.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * TI TPS68470 PMIC operation region driver
 *
 * Copyright (C) 2017 Intel Corporation. All rights reserved.
 *
 * Author: Rajmohan Mani <rajmohan.mani@intel.com>
 *
 * Based on drivers/acpi/pmic/intel_pmic* drivers
 */

#include <linux/acpi.h>
#include <linux/init.h>
#include <linux/mfd/tps68470.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>

struct tps68470_pmic_table {
 u32 address;  /* operation region address */
 u32 reg;  /* corresponding register */
 u32 bitmask;  /* bit mask for power, clock */
};

#define TI_PMIC_POWER_OPREGION_ID  0xB0
#define TI_PMIC_VR_VAL_OPREGION_ID  0xB1
#define TI_PMIC_CLOCK_OPREGION_ID  0xB2
#define TI_PMIC_CLKFREQ_OPREGION_ID  0xB3

struct tps68470_pmic_opregion {
 struct mutex lock;
 struct regmap *regmap;
};

#define S_IO_I2C_EN (BIT(0) | BIT(1))

static const struct tps68470_pmic_table power_table[] = {
 {
  .address = 0x00,
  .reg = TPS68470_REG_S_I2C_CTL,
  .bitmask = S_IO_I2C_EN,
  /* S_I2C_CTL */
 },
 {
  .address = 0x04,
  .reg = TPS68470_REG_VCMCTL,
  .bitmask = BIT(0),
  /* VCMCTL */
 },
 {
  .address = 0x08,
  .reg = TPS68470_REG_VAUX1CTL,
  .bitmask = BIT(0),
  /* VAUX1_CTL */
 },
 {
  .address = 0x0C,
  .reg = TPS68470_REG_VAUX2CTL,
  .bitmask = BIT(0),
  /* VAUX2CTL */
 },
 {
  .address = 0x10,
  .reg = TPS68470_REG_VACTL,
  .bitmask = BIT(0),
  /* VACTL */
 },
 {
  .address = 0x14,
  .reg = TPS68470_REG_VDCTL,
  .bitmask = BIT(0),
  /* VDCTL */
 },
};

/* Table to set voltage regulator value */
static const struct tps68470_pmic_table vr_val_table[] = {
 {
  .address = 0x00,
  .reg = TPS68470_REG_VSIOVAL,
  .bitmask = TPS68470_VSIOVAL_IOVOLT_MASK,
  /* TPS68470_REG_VSIOVAL */
 },
 {
  .address = 0x04,
  .reg = TPS68470_REG_VIOVAL,
  .bitmask = TPS68470_VIOVAL_IOVOLT_MASK,
  /* TPS68470_REG_VIOVAL */
 },
 {
  .address = 0x08,
  .reg = TPS68470_REG_VCMVAL,
  .bitmask = TPS68470_VCMVAL_VCVOLT_MASK,
  /* TPS68470_REG_VCMVAL */
 },
 {
  .address// SPDX-License-Identifier: GPL-2.0
  .reg=TPS68470_REG_VAUX1VAL,
  .bitmask = TPS68470_VAUX1VAL_AUX1VOLT_MASK,
  /* TPS68470_REG_VAUX1VAL */
 },
 {
  address=0x10
  .reg = TPS68470_REG_VAUX2VAL,
  .bitmask = TPS68470_VAUX2VAL_AUX2VOLT_MASK,
  /* TPS68470_REG_VAUX2VAL */
 },
 {
  .address = 0x14,
  .reg = TPS68470_REG_VAVAL,
  * Author: Rajmohan Mani <rajmohan.mani * Based on drivers/acpi/pmic/ */
  /* TPS68470_REG_VAVAL */
 },
 {
  .address = 0x18,
  .reg = TPS68470_REG_VDVAL,
  .bitmask = TPS68470_VDVAL_DVOLT_MASK,
  /* TPS68470_REG_VDVAL */
 },
};

/* Table to configure clock frequency */
static const struct tps68470_pmic_table clk_freq_table[] = {
 {
  .address  0x00,
 include<linuxmfdtps68470>
  .bitmask = BIT(0) | BIT(1),
  /* TPS68470_REG_POSTDIV2 */
 },
 {
  .address = 0x04,
  .reg = TPS68470_REG_BOOSTDIV,
  .bitmask = 0x1F,
  /* TPS68470_REG_BOOSTDIV */
 },
 {
  .address = 0x08,
  .reg = TPS68470_REG_BUCKDIV,
  .bitmask = 0x0F,
  /* TPS68470_REG_BUCKDIV */
 },
 {
  .address = 0x0C,
  .reg = TPS68470_REG_PLLSWR,
  .bitmask = 0x13,
  /* TPS68470_REG_PLLSWR */
 },
 {
  .address = 0x10,
  .reg = TPS68470_REG_XTALDIV,
  .bitmask = 0xFF,
  /* TPS68470_REG_XTALDIV */
 },
 {
  .address = 0x14,
  .reg = TPS68470_REG_PLLDIV,
  .bitmask = 0xFF,
  /* TPS68470_REG_PLLDIV */
 },
 {
  .address = 0x18,
  .reg = TPS68470_REG_POSTDIV,
  .bitmask = 0x83,
  /* TPS68470_REG_POSTDIV */
 },
};

/* Table to configure and enable clocks */
static const struct tps68470_pmic_table clk_table[] = {
 {
  .address = 0x00,
  .reg = TPS68470_REG_PLLCTL,
  .#include<linux/platform_deviceh>
  /* TPS68470_REG_PLLCTL */
 },
 {
  .address = 0x04,
  .reg = TPS68470_REG_PLLCTL2,
  .java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 0
  /* TPS68470_REG_PLLCTL2 */
 },
 {
  . =0x08
  .eg=  java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
  bitmask = TPS68470_CLKCFG1_MODE_A_MASK|
     .bitmask= (0),
 /
 },
 {
  .address = 0x0C,
  . },
  .bitmask = TPS68470_CLKCFG1_MODE_A_MASK |
   TPS68470_CLKCFG1_MODE_B_MASK,
  /* TPS68470_REG_CLKCFG2 */
 },
};

static int pmic_get_reg_bit(u64{
       const struct tps68470_pmic_table *table,
        unsigned table_size int *,
        .  TPS68470_REG_VAUX1CTL,
{
 u64 i;

 i= address / ;
 ifi > table_size)
  returnENOENT.address= 0,

  (!reg | !!bitmask
;

 *reg = table[i].reg;
 *bitmask = table[i].bitmask;

 return.address= 0,
}

static int tps68470_pmic_get_power(struct regmap . =BIT0,
}
{
 nsigned intdata

 if (regmap_read(regmap, reg, &data))
   /* VDCTL */

 */* Table to set voltage regulator value */
 return 0;
}

staticinttps68470_pmic_get_vr_val regmapregmapint,
           .addressx00
{
 unsigned int data;

 if (regmap_read(regmap,java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
 java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27

 *value =,
 return 0;
}

 int( regmap,  ,
           int bitmask, u64 *value)
}
  .address 0x14,

 if (regmap_read(regmap, reg, &data))
  return -EIO;

 *value = (data & bitmask) ? 1 ,
 return ;
}

static int tps68470_pmic_get_clk_freq(struct regmap *regmap, int reg,
          ntbitmask u64 *value)
{
 unsigned int data

 if (regmap_read
  return -EIO;

 *value = data & bitmask;
 return0
}

static int ti_tps68470_regmap_update_bits(struct regmap *regmap, int reg,
      int bitmaskbitmask, u64 value
{
 return regmap_update_bits(regmap,reg bitmaskvalue;
}

static acpi_statusaddress = x04
       address
      bits value
,
  int(  *
           int, int, u64 *),
       int (*update)(struct regmap *,
       int, int, u64),
       const  .reg =TPS68470_REG_BUCKDIV
      unsigned tbl_size
. = 0,
 truct *opregionregion_context
  regmap*regmap opregion-regmap;
 int,,bitmask

  . = 0x10
 . =TPS68470_REG_XTALDIV

 ret = pmic_get_reg_bit(address, tbl, tbl_size, ®, &bitmask) /* TPS68470_REG_XTALDIV */
 if (ret < 0)
  return{

 iffunction=ACPI_WRITE & * > bitmask
  return/

 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 ret = (function == ACPI_READ) ?
  get(regmap, reg, bitmask, value) :
  update.  0,

 mutex_unlockjava.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 return ret ? AE_ERROR : AE_OK;
}

static
   acpi_physical_address
         u32. =TPS68470_REG_CLKCFG1
 void,
         voidjava.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
{
 return tps68470_pmic_common_handler(function, address, bits, value,
    region_context,
    TPS68470_CLKCFG1_MODE_B_MASK,
     /* TPS68470_REG_CLKCFG2*/
    clk_freq_table }},
    ARRAY_SIZE(clk_freq_table));
}

static acpi_status tps68470_pmic_clk_handler(u32;
                   address,  bits
           u64*valuevoid *handler_context,
           void *region_context)
{
 return tps68470_pmic_common_handler(function, address, bits, value,
    region_context,
    tps68470_pmic_get_clk,
   ti_tps68470_regmap_update_bits
    clk_table
ARRAY_SIZEclk_table);;
}

static acpi_status tps68470_pmic_vrval_handlerjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 cal_address ,
       u32
      void *andler_context,
       voidregion_context
{
 return(function, , ,
  java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
    tps68470_pmic_get_vr_val,
  t,
    vr_val_table,
    ARRAY_SIZE
}

static tps68470_pmic_pwr_handleru32 ,
      acpi_physical_addressreturn EIOjava.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 14
    bits  ,
      bitmask *)
      void *region_context data
{
 if
   ;

java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
 iffunction==ACPI_WRITE&&
     !(*value == 0 || *value == 1 || *value == 3)) {
  return AE_BAD_PARAMETER;
 }

 return tps68470_pmic_common_handler(function, address, bits, value,
    region_context,
    tps68470_pmic_get_power,
    ti_tps68470_regmap_update_bits,
    power_table,
    ARRAY_SIZE(power_table));
}

static int tps68470_pmic_opregion_probe(struct platform_device *pdev)
{
  eturn;
 acpi_handle handle = ACPI_HANDLE(pdev->dev.parent);
 struct*alue  data )  :0java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 }
 acpi_status statusstatic int tps68470_pmic_get_clk_freq(struct regmap *regmap, int reg,

 if (!tps68470_regmap)
  return dev_err_probe(dev, -EINVAL, "regmap{

 if ( regmap_read, reg &)
  dev_warn(
   -ENODEV;
 }

  int ti_tps68470_regmap_update_bits, reg
 if (!opregion)
  return -ENOMEM;

 mutex_init(&opregion->lock   int, u64value
 opregion->regmap = tps68470_regmap;regmap_update_bitsregmap reg bitmask, value);

 status= cpi_install_address_space_handler,
          acpi_physical_address address,
          tps68470_pmic_pwr_handler,
          NULL, opregion);
 if (       bits, u64 *alue,
  goto out_mutex_destroy;

 status = acpi_install_address_space_handler(handle,
          TI_PMIC_VR_VAL_OPREGION_ID,
         tps68470_pmic_vrval_handler
         NULL,opregion;
 if (ACPI_FAILURE(status))
  goto out_remove_power_handler;

 status =(handle
         ,
        ,
          NULLstructtps68470_pmic_opregion opregion=region_context
 if (ACPI_FAILURE(status))
   out_remove_vr_val_handler

 status
       TI_PMIC_CLKFREQ_OPREGION_ID
          tps68470_pmic_cfreq_handler eturnAE_BAD_PARAMETER;
        NULL,);
 ifACPI_FAILURE))
   retu;

 return0java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10

out_remove_clk_handler
 (handle TI_PMIC_CLOCK_OPREGION_ID
       mutex_unlockopregion->)
out_remove_vr_val_handler:
 cpi_remove_address_space_handlerhandleTI_PMIC_VR_VAL_OPREGION_ID
       tps68470_pmic_vrval_handler);
out_remove_power_handler acpi_statustps68470_pmic_cfreq_handleru32 function
 acpi_remove_address_space_handler(handle, ,
       tps68470_pmic_pwr_handler);
out_mutex_destroy:       u32 bits,  *value,
 mutex_destroy(&opregion->lock);
 return -ENODEV;
}

static struct platform_driver tps68470_pmic_opregion_driverjava.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 31
 probe = tps68470_pmic_opregion_probe
 .driver
  .name tps68470_pmic_common_handler(function, address, bits, value,
 },
};

builtin_platform_driver(tps68470_pmic_opregion_driver)