target/linux/ipq806x/patches-5.10/104-3-drivers-thermal-tsens-Convert-msm8960-to-reg_field.patch

   1 From 6bac2e2fa36c2d7c304768a689d8b73155b90aa2 Mon Sep 17 00:00:00 2001
   2 From: Ansuel Smith <ansuelsmth@gmail.com>
   3 Date: Wed, 25 Nov 2020 17:15:51 +0100
   4 Subject: [PATCH 03/10] drivers: thermal: tsens: Convert msm8960 to reg_field
   5
   6 Convert msm9860 driver to reg_field to use the init_common
   7 function.
   8
   9 Signed-off-by: Ansuel Smith <ansuelsmth@gmail.com>
  10 Acked-by: Thara Gopinath <thara.gopinath@linaro.org>
  11 ---
  12  drivers/thermal/qcom/tsens-8960.c | 80 ++++++++++++++++++++++++++++++-
  13  1 file changed, 79 insertions(+), 1 deletion(-)
  14
  15 --- a/drivers/thermal/qcom/tsens-8960.c
  16 +++ b/drivers/thermal/qcom/tsens-8960.c
  17 @@ -51,11 +51,22 @@
  18  #define MIN_LIMIT_TH           0x0
  19  #define MAX_LIMIT_TH           0xff
  20
  21 -#define S0_STATUS_ADDR         0x3628
  22  #define INT_STATUS_ADDR                0x363c
  23  #define TRDY_MASK              BIT(7)
  24  #define TIMEOUT_US             100
  25
  26 +#define S0_STATUS_OFF          0x3628
  27 +#define S1_STATUS_OFF          0x362c
  28 +#define S2_STATUS_OFF          0x3630
  29 +#define S3_STATUS_OFF          0x3634
  30 +#define S4_STATUS_OFF          0x3638
  31 +#define S5_STATUS_OFF          0x3664  /* Sensors 5-10 found on apq8064/msm8960 */
  32 +#define S6_STATUS_OFF          0x3668
  33 +#define S7_STATUS_OFF          0x366c
  34 +#define S8_STATUS_OFF          0x3670
  35 +#define S9_STATUS_OFF          0x3674
  36 +#define S10_STATUS_OFF         0x3678
  37 +
  38  static int suspend_8960(struct tsens_priv *priv)
  39  {
  40         int ret;
  41 @@ -269,6 +280,71 @@ static int get_temp_8960(const struct ts
  42         return -ETIMEDOUT;
  43  }
  44
  45 +static struct tsens_features tsens_8960_feat = {
  46 +       .ver_major      = VER_0,
  47 +       .crit_int       = 0,
  48 +       .adc            = 1,
  49 +       .srot_split     = 0,
  50 +       .max_sensors    = 11,
  51 +};
  52 +
  53 +static const struct reg_field tsens_8960_regfields[MAX_REGFIELDS] = {
  54 +       /* ----- SROT ------ */
  55 +       /* No VERSION information */
  56 +
  57 +       /* CNTL */
  58 +       [TSENS_EN]     = REG_FIELD(CNTL_ADDR,  0, 0),
  59 +       [TSENS_SW_RST] = REG_FIELD(CNTL_ADDR,  1, 1),
  60 +       /* 8960 has 5 sensors, 8660 has 11, we only handle 5 */
  61 +       [SENSOR_EN]    = REG_FIELD(CNTL_ADDR,  3, 7),
  62 +
  63 +       /* ----- TM ------ */
  64 +       /* INTERRUPT ENABLE */
  65 +       /* NO INTERRUPT ENABLE */
  66 +
  67 +       /* Single UPPER/LOWER TEMPERATURE THRESHOLD for all sensors */
  68 +       [LOW_THRESH_0]   = REG_FIELD(THRESHOLD_ADDR,  0,  7),
  69 +       [UP_THRESH_0]    = REG_FIELD(THRESHOLD_ADDR,  8, 15),
  70 +       /* MIN_THRESH_0 and MAX_THRESH_0 are not present in the regfield
  71 +        * Recycle CRIT_THRESH_0 and 1 to set the required regs to hardcoded temp
  72 +        * MIN_THRESH_0 -> CRIT_THRESH_1
  73 +        * MAX_THRESH_0 -> CRIT_THRESH_0
  74 +        */
  75 +       [CRIT_THRESH_1]   = REG_FIELD(THRESHOLD_ADDR, 16, 23),
  76 +       [CRIT_THRESH_0]   = REG_FIELD(THRESHOLD_ADDR, 24, 31),
  77 +
  78 +       /* UPPER/LOWER INTERRUPT [CLEAR/STATUS] */
  79 +       /* 1 == clear, 0 == normal operation */
  80 +       [LOW_INT_CLEAR_0]   = REG_FIELD(CNTL_ADDR,  9,  9),
  81 +       [UP_INT_CLEAR_0]    = REG_FIELD(CNTL_ADDR, 10, 10),
  82 +
  83 +       /* NO CRITICAL INTERRUPT SUPPORT on 8960 */
  84 +
  85 +       /* Sn_STATUS */
  86 +       [LAST_TEMP_0]  = REG_FIELD(S0_STATUS_OFF,  0,  7),
  87 +       [LAST_TEMP_1]  = REG_FIELD(S1_STATUS_OFF,  0,  7),
  88 +       [LAST_TEMP_2]  = REG_FIELD(S2_STATUS_OFF,  0,  7),
  89 +       [LAST_TEMP_3]  = REG_FIELD(S3_STATUS_OFF,  0,  7),
  90 +       [LAST_TEMP_4]  = REG_FIELD(S4_STATUS_OFF,  0,  7),
  91 +       [LAST_TEMP_5]  = REG_FIELD(S5_STATUS_OFF,  0,  7),
  92 +       [LAST_TEMP_6]  = REG_FIELD(S6_STATUS_OFF,  0,  7),
  93 +       [LAST_TEMP_7]  = REG_FIELD(S7_STATUS_OFF,  0,  7),
  94 +       [LAST_TEMP_8]  = REG_FIELD(S8_STATUS_OFF,  0,  7),
  95 +       [LAST_TEMP_9]  = REG_FIELD(S9_STATUS_OFF,  0,  7),
  96 +       [LAST_TEMP_10] = REG_FIELD(S10_STATUS_OFF, 0,  7),
  97 +
  98 +       /* No VALID field on 8960 */
  99 +       /* TSENS_INT_STATUS bits: 1 == threshold violated */
 100 +       [MIN_STATUS_0] = REG_FIELD(INT_STATUS_ADDR, 0, 0),
 101 +       [LOWER_STATUS_0] = REG_FIELD(INT_STATUS_ADDR, 1, 1),
 102 +       [UPPER_STATUS_0] = REG_FIELD(INT_STATUS_ADDR, 2, 2),
 103 +       /* No CRITICAL field on 8960 */
 104 +       [MAX_STATUS_0] = REG_FIELD(INT_STATUS_ADDR, 3, 3),
 105 +
 106 +       /* TRDY: 1=ready, 0=in progress */
 107 +       [TRDY] = REG_FIELD(INT_STATUS_ADDR, 7, 7),
 108 +};
 109 +
 110  static const struct tsens_ops ops_8960 = {
 111         .init           = init_8960,
 112         .calibrate      = calibrate_8960,
 113 @@ -282,4 +358,6 @@ static const struct tsens_ops ops_8960 =
 114  struct tsens_plat_data data_8960 = {
 115         .num_sensors    = 11,
 116         .ops            = &ops_8960,
 117 +       .feat           = &tsens_8960_feat,
 118 +       .fields         = tsens_8960_regfields,
 119  };