1106b1041SKamel Bouhara // SPDX-License-Identifier: GPL-2.0-only 2106b1041SKamel Bouhara /** 3106b1041SKamel Bouhara * Copyright (C) 2020 Microchip 4106b1041SKamel Bouhara * 5106b1041SKamel Bouhara * Author: Kamel Bouhara <kamel.bouhara@bootlin.com> 6106b1041SKamel Bouhara */ 7106b1041SKamel Bouhara #include <linux/clk.h> 8106b1041SKamel Bouhara #include <linux/counter.h> 9106b1041SKamel Bouhara #include <linux/mfd/syscon.h> 10106b1041SKamel Bouhara #include <linux/module.h> 11106b1041SKamel Bouhara #include <linux/mutex.h> 12106b1041SKamel Bouhara #include <linux/of.h> 13106b1041SKamel Bouhara #include <linux/of_device.h> 14106b1041SKamel Bouhara #include <linux/platform_device.h> 15106b1041SKamel Bouhara #include <linux/regmap.h> 16106b1041SKamel Bouhara #include <soc/at91/atmel_tcb.h> 17106b1041SKamel Bouhara 18106b1041SKamel Bouhara #define ATMEL_TC_CMR_MASK (ATMEL_TC_LDRA_RISING | ATMEL_TC_LDRB_FALLING | \ 19106b1041SKamel Bouhara ATMEL_TC_ETRGEDG_RISING | ATMEL_TC_LDBDIS | \ 20106b1041SKamel Bouhara ATMEL_TC_LDBSTOP) 21106b1041SKamel Bouhara 22106b1041SKamel Bouhara #define ATMEL_TC_QDEN BIT(8) 23106b1041SKamel Bouhara #define ATMEL_TC_POSEN BIT(9) 24106b1041SKamel Bouhara 25106b1041SKamel Bouhara struct mchp_tc_data { 26106b1041SKamel Bouhara const struct atmel_tcb_config *tc_cfg; 27106b1041SKamel Bouhara struct counter_device counter; 28106b1041SKamel Bouhara struct regmap *regmap; 29106b1041SKamel Bouhara int qdec_mode; 30106b1041SKamel Bouhara int num_channels; 31106b1041SKamel Bouhara int channel[2]; 32106b1041SKamel Bouhara bool trig_inverted; 33106b1041SKamel Bouhara }; 34106b1041SKamel Bouhara 35106b1041SKamel Bouhara enum mchp_tc_count_function { 36106b1041SKamel Bouhara MCHP_TC_FUNCTION_INCREASE, 37106b1041SKamel Bouhara MCHP_TC_FUNCTION_QUADRATURE, 38106b1041SKamel Bouhara }; 39106b1041SKamel Bouhara 40106b1041SKamel Bouhara static enum counter_count_function mchp_tc_count_functions[] = { 41106b1041SKamel Bouhara [MCHP_TC_FUNCTION_INCREASE] = COUNTER_COUNT_FUNCTION_INCREASE, 42106b1041SKamel Bouhara [MCHP_TC_FUNCTION_QUADRATURE] = COUNTER_COUNT_FUNCTION_QUADRATURE_X4, 43106b1041SKamel Bouhara }; 44106b1041SKamel Bouhara 45106b1041SKamel Bouhara enum mchp_tc_synapse_action { 46106b1041SKamel Bouhara MCHP_TC_SYNAPSE_ACTION_NONE = 0, 47106b1041SKamel Bouhara MCHP_TC_SYNAPSE_ACTION_RISING_EDGE, 48106b1041SKamel Bouhara MCHP_TC_SYNAPSE_ACTION_FALLING_EDGE, 49106b1041SKamel Bouhara MCHP_TC_SYNAPSE_ACTION_BOTH_EDGE 50106b1041SKamel Bouhara }; 51106b1041SKamel Bouhara 52106b1041SKamel Bouhara static enum counter_synapse_action mchp_tc_synapse_actions[] = { 53106b1041SKamel Bouhara [MCHP_TC_SYNAPSE_ACTION_NONE] = COUNTER_SYNAPSE_ACTION_NONE, 54106b1041SKamel Bouhara [MCHP_TC_SYNAPSE_ACTION_RISING_EDGE] = COUNTER_SYNAPSE_ACTION_RISING_EDGE, 55106b1041SKamel Bouhara [MCHP_TC_SYNAPSE_ACTION_FALLING_EDGE] = COUNTER_SYNAPSE_ACTION_FALLING_EDGE, 56106b1041SKamel Bouhara [MCHP_TC_SYNAPSE_ACTION_BOTH_EDGE] = COUNTER_SYNAPSE_ACTION_BOTH_EDGES, 57106b1041SKamel Bouhara }; 58106b1041SKamel Bouhara 59106b1041SKamel Bouhara static struct counter_signal mchp_tc_count_signals[] = { 60106b1041SKamel Bouhara { 61106b1041SKamel Bouhara .id = 0, 62106b1041SKamel Bouhara .name = "Channel A", 63106b1041SKamel Bouhara }, 64106b1041SKamel Bouhara { 65106b1041SKamel Bouhara .id = 1, 66106b1041SKamel Bouhara .name = "Channel B", 67106b1041SKamel Bouhara } 68106b1041SKamel Bouhara }; 69106b1041SKamel Bouhara 70106b1041SKamel Bouhara static struct counter_synapse mchp_tc_count_synapses[] = { 71106b1041SKamel Bouhara { 72106b1041SKamel Bouhara .actions_list = mchp_tc_synapse_actions, 73106b1041SKamel Bouhara .num_actions = ARRAY_SIZE(mchp_tc_synapse_actions), 74106b1041SKamel Bouhara .signal = &mchp_tc_count_signals[0] 75106b1041SKamel Bouhara }, 76106b1041SKamel Bouhara { 77106b1041SKamel Bouhara .actions_list = mchp_tc_synapse_actions, 78106b1041SKamel Bouhara .num_actions = ARRAY_SIZE(mchp_tc_synapse_actions), 79106b1041SKamel Bouhara .signal = &mchp_tc_count_signals[1] 80106b1041SKamel Bouhara } 81106b1041SKamel Bouhara }; 82106b1041SKamel Bouhara 83106b1041SKamel Bouhara static int mchp_tc_count_function_get(struct counter_device *counter, 84106b1041SKamel Bouhara struct counter_count *count, 85106b1041SKamel Bouhara size_t *function) 86106b1041SKamel Bouhara { 87106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 88106b1041SKamel Bouhara 89106b1041SKamel Bouhara if (priv->qdec_mode) 90106b1041SKamel Bouhara *function = MCHP_TC_FUNCTION_QUADRATURE; 91106b1041SKamel Bouhara else 92106b1041SKamel Bouhara *function = MCHP_TC_FUNCTION_INCREASE; 93106b1041SKamel Bouhara 94106b1041SKamel Bouhara return 0; 95106b1041SKamel Bouhara } 96106b1041SKamel Bouhara 97106b1041SKamel Bouhara static int mchp_tc_count_function_set(struct counter_device *counter, 98106b1041SKamel Bouhara struct counter_count *count, 99106b1041SKamel Bouhara size_t function) 100106b1041SKamel Bouhara { 101106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 102106b1041SKamel Bouhara u32 bmr, cmr; 103106b1041SKamel Bouhara 104106b1041SKamel Bouhara regmap_read(priv->regmap, ATMEL_TC_BMR, &bmr); 105106b1041SKamel Bouhara regmap_read(priv->regmap, ATMEL_TC_REG(priv->channel[0], CMR), &cmr); 106106b1041SKamel Bouhara 107106b1041SKamel Bouhara /* Set capture mode */ 108106b1041SKamel Bouhara cmr &= ~ATMEL_TC_WAVE; 109106b1041SKamel Bouhara 110106b1041SKamel Bouhara switch (function) { 111106b1041SKamel Bouhara case MCHP_TC_FUNCTION_INCREASE: 112106b1041SKamel Bouhara priv->qdec_mode = 0; 113106b1041SKamel Bouhara /* Set highest rate based on whether soc has gclk or not */ 114106b1041SKamel Bouhara bmr &= ~(ATMEL_TC_QDEN | ATMEL_TC_POSEN); 115106b1041SKamel Bouhara if (priv->tc_cfg->has_gclk) 116106b1041SKamel Bouhara cmr |= ATMEL_TC_TIMER_CLOCK2; 117106b1041SKamel Bouhara else 118106b1041SKamel Bouhara cmr |= ATMEL_TC_TIMER_CLOCK1; 119106b1041SKamel Bouhara /* Setup the period capture mode */ 120106b1041SKamel Bouhara cmr |= ATMEL_TC_CMR_MASK; 121106b1041SKamel Bouhara cmr &= ~(ATMEL_TC_ABETRG | ATMEL_TC_XC0); 122106b1041SKamel Bouhara break; 123106b1041SKamel Bouhara case MCHP_TC_FUNCTION_QUADRATURE: 124106b1041SKamel Bouhara if (!priv->tc_cfg->has_qdec) 125106b1041SKamel Bouhara return -EINVAL; 126106b1041SKamel Bouhara /* In QDEC mode settings both channels 0 and 1 are required */ 127106b1041SKamel Bouhara if (priv->num_channels < 2 || priv->channel[0] != 0 || 128106b1041SKamel Bouhara priv->channel[1] != 1) { 129106b1041SKamel Bouhara pr_err("Invalid channels number or id for quadrature mode\n"); 130106b1041SKamel Bouhara return -EINVAL; 131106b1041SKamel Bouhara } 132106b1041SKamel Bouhara priv->qdec_mode = 1; 133106b1041SKamel Bouhara bmr |= ATMEL_TC_QDEN | ATMEL_TC_POSEN; 134106b1041SKamel Bouhara cmr |= ATMEL_TC_ETRGEDG_RISING | ATMEL_TC_ABETRG | ATMEL_TC_XC0; 135106b1041SKamel Bouhara break; 136106b1041SKamel Bouhara } 137106b1041SKamel Bouhara 138106b1041SKamel Bouhara regmap_write(priv->regmap, ATMEL_TC_BMR, bmr); 139106b1041SKamel Bouhara regmap_write(priv->regmap, ATMEL_TC_REG(priv->channel[0], CMR), cmr); 140106b1041SKamel Bouhara 141106b1041SKamel Bouhara /* Enable clock and trigger counter */ 142106b1041SKamel Bouhara regmap_write(priv->regmap, ATMEL_TC_REG(priv->channel[0], CCR), 143106b1041SKamel Bouhara ATMEL_TC_CLKEN | ATMEL_TC_SWTRG); 144106b1041SKamel Bouhara 145106b1041SKamel Bouhara if (priv->qdec_mode) { 146106b1041SKamel Bouhara regmap_write(priv->regmap, 147106b1041SKamel Bouhara ATMEL_TC_REG(priv->channel[1], CMR), cmr); 148106b1041SKamel Bouhara regmap_write(priv->regmap, 149106b1041SKamel Bouhara ATMEL_TC_REG(priv->channel[1], CCR), 150106b1041SKamel Bouhara ATMEL_TC_CLKEN | ATMEL_TC_SWTRG); 151106b1041SKamel Bouhara } 152106b1041SKamel Bouhara 153106b1041SKamel Bouhara return 0; 154106b1041SKamel Bouhara } 155106b1041SKamel Bouhara 156106b1041SKamel Bouhara static int mchp_tc_count_signal_read(struct counter_device *counter, 157106b1041SKamel Bouhara struct counter_signal *signal, 158106b1041SKamel Bouhara enum counter_signal_value *val) 159106b1041SKamel Bouhara { 160106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 161106b1041SKamel Bouhara bool sigstatus; 162106b1041SKamel Bouhara u32 sr; 163106b1041SKamel Bouhara 164106b1041SKamel Bouhara regmap_read(priv->regmap, ATMEL_TC_REG(priv->channel[0], SR), &sr); 165106b1041SKamel Bouhara 166106b1041SKamel Bouhara if (priv->trig_inverted) 167106b1041SKamel Bouhara sigstatus = (sr & ATMEL_TC_MTIOB); 168106b1041SKamel Bouhara else 169106b1041SKamel Bouhara sigstatus = (sr & ATMEL_TC_MTIOA); 170106b1041SKamel Bouhara 171106b1041SKamel Bouhara *val = sigstatus ? COUNTER_SIGNAL_HIGH : COUNTER_SIGNAL_LOW; 172106b1041SKamel Bouhara 173106b1041SKamel Bouhara return 0; 174106b1041SKamel Bouhara } 175106b1041SKamel Bouhara 176106b1041SKamel Bouhara static int mchp_tc_count_action_get(struct counter_device *counter, 177106b1041SKamel Bouhara struct counter_count *count, 178106b1041SKamel Bouhara struct counter_synapse *synapse, 179106b1041SKamel Bouhara size_t *action) 180106b1041SKamel Bouhara { 181106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 182106b1041SKamel Bouhara u32 cmr; 183106b1041SKamel Bouhara 184106b1041SKamel Bouhara regmap_read(priv->regmap, ATMEL_TC_REG(priv->channel[0], CMR), &cmr); 185106b1041SKamel Bouhara 186106b1041SKamel Bouhara *action = MCHP_TC_SYNAPSE_ACTION_NONE; 187106b1041SKamel Bouhara 188106b1041SKamel Bouhara if (cmr & ATMEL_TC_ETRGEDG_NONE) 189106b1041SKamel Bouhara *action = MCHP_TC_SYNAPSE_ACTION_NONE; 190106b1041SKamel Bouhara else if (cmr & ATMEL_TC_ETRGEDG_RISING) 191106b1041SKamel Bouhara *action = MCHP_TC_SYNAPSE_ACTION_RISING_EDGE; 192106b1041SKamel Bouhara else if (cmr & ATMEL_TC_ETRGEDG_FALLING) 193106b1041SKamel Bouhara *action = MCHP_TC_SYNAPSE_ACTION_FALLING_EDGE; 194106b1041SKamel Bouhara else if (cmr & ATMEL_TC_ETRGEDG_BOTH) 195106b1041SKamel Bouhara *action = MCHP_TC_SYNAPSE_ACTION_BOTH_EDGE; 196106b1041SKamel Bouhara 197106b1041SKamel Bouhara return 0; 198106b1041SKamel Bouhara } 199106b1041SKamel Bouhara 200106b1041SKamel Bouhara static int mchp_tc_count_action_set(struct counter_device *counter, 201106b1041SKamel Bouhara struct counter_count *count, 202106b1041SKamel Bouhara struct counter_synapse *synapse, 203106b1041SKamel Bouhara size_t action) 204106b1041SKamel Bouhara { 205106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 206106b1041SKamel Bouhara u32 edge = ATMEL_TC_ETRGEDG_NONE; 207106b1041SKamel Bouhara 208106b1041SKamel Bouhara /* QDEC mode is rising edge only */ 209106b1041SKamel Bouhara if (priv->qdec_mode) 210106b1041SKamel Bouhara return -EINVAL; 211106b1041SKamel Bouhara 212106b1041SKamel Bouhara switch (action) { 213106b1041SKamel Bouhara case MCHP_TC_SYNAPSE_ACTION_NONE: 214106b1041SKamel Bouhara edge = ATMEL_TC_ETRGEDG_NONE; 215106b1041SKamel Bouhara break; 216106b1041SKamel Bouhara case MCHP_TC_SYNAPSE_ACTION_RISING_EDGE: 217106b1041SKamel Bouhara edge = ATMEL_TC_ETRGEDG_RISING; 218106b1041SKamel Bouhara break; 219106b1041SKamel Bouhara case MCHP_TC_SYNAPSE_ACTION_FALLING_EDGE: 220106b1041SKamel Bouhara edge = ATMEL_TC_ETRGEDG_FALLING; 221106b1041SKamel Bouhara break; 222106b1041SKamel Bouhara case MCHP_TC_SYNAPSE_ACTION_BOTH_EDGE: 223106b1041SKamel Bouhara edge = ATMEL_TC_ETRGEDG_BOTH; 224106b1041SKamel Bouhara break; 225106b1041SKamel Bouhara } 226106b1041SKamel Bouhara 227106b1041SKamel Bouhara return regmap_write_bits(priv->regmap, 228106b1041SKamel Bouhara ATMEL_TC_REG(priv->channel[0], CMR), 229106b1041SKamel Bouhara ATMEL_TC_ETRGEDG, edge); 230106b1041SKamel Bouhara } 231106b1041SKamel Bouhara 232106b1041SKamel Bouhara static int mchp_tc_count_read(struct counter_device *counter, 233106b1041SKamel Bouhara struct counter_count *count, 234106b1041SKamel Bouhara unsigned long *val) 235106b1041SKamel Bouhara { 236106b1041SKamel Bouhara struct mchp_tc_data *const priv = counter->priv; 237106b1041SKamel Bouhara u32 cnt; 238106b1041SKamel Bouhara 239106b1041SKamel Bouhara regmap_read(priv->regmap, ATMEL_TC_REG(priv->channel[0], CV), &cnt); 240106b1041SKamel Bouhara *val = cnt; 241106b1041SKamel Bouhara 242106b1041SKamel Bouhara return 0; 243106b1041SKamel Bouhara } 244106b1041SKamel Bouhara 245106b1041SKamel Bouhara static struct counter_count mchp_tc_counts[] = { 246106b1041SKamel Bouhara { 247106b1041SKamel Bouhara .id = 0, 248106b1041SKamel Bouhara .name = "Timer Counter", 249106b1041SKamel Bouhara .functions_list = mchp_tc_count_functions, 250106b1041SKamel Bouhara .num_functions = ARRAY_SIZE(mchp_tc_count_functions), 251106b1041SKamel Bouhara .synapses = mchp_tc_count_synapses, 252106b1041SKamel Bouhara .num_synapses = ARRAY_SIZE(mchp_tc_count_synapses), 253106b1041SKamel Bouhara }, 254106b1041SKamel Bouhara }; 255106b1041SKamel Bouhara 256106b1041SKamel Bouhara static struct counter_ops mchp_tc_ops = { 257106b1041SKamel Bouhara .signal_read = mchp_tc_count_signal_read, 258106b1041SKamel Bouhara .count_read = mchp_tc_count_read, 259106b1041SKamel Bouhara .function_get = mchp_tc_count_function_get, 260106b1041SKamel Bouhara .function_set = mchp_tc_count_function_set, 261106b1041SKamel Bouhara .action_get = mchp_tc_count_action_get, 262106b1041SKamel Bouhara .action_set = mchp_tc_count_action_set 263106b1041SKamel Bouhara }; 264106b1041SKamel Bouhara 265106b1041SKamel Bouhara static const struct atmel_tcb_config tcb_rm9200_config = { 266106b1041SKamel Bouhara .counter_width = 16, 267106b1041SKamel Bouhara }; 268106b1041SKamel Bouhara 269106b1041SKamel Bouhara static const struct atmel_tcb_config tcb_sam9x5_config = { 270106b1041SKamel Bouhara .counter_width = 32, 271106b1041SKamel Bouhara }; 272106b1041SKamel Bouhara 273106b1041SKamel Bouhara static const struct atmel_tcb_config tcb_sama5d2_config = { 274106b1041SKamel Bouhara .counter_width = 32, 275106b1041SKamel Bouhara .has_gclk = true, 276106b1041SKamel Bouhara .has_qdec = true, 277106b1041SKamel Bouhara }; 278106b1041SKamel Bouhara 279106b1041SKamel Bouhara static const struct atmel_tcb_config tcb_sama5d3_config = { 280106b1041SKamel Bouhara .counter_width = 32, 281106b1041SKamel Bouhara .has_qdec = true, 282106b1041SKamel Bouhara }; 283106b1041SKamel Bouhara 284106b1041SKamel Bouhara static const struct of_device_id atmel_tc_of_match[] = { 285106b1041SKamel Bouhara { .compatible = "atmel,at91rm9200-tcb", .data = &tcb_rm9200_config, }, 286106b1041SKamel Bouhara { .compatible = "atmel,at91sam9x5-tcb", .data = &tcb_sam9x5_config, }, 287106b1041SKamel Bouhara { .compatible = "atmel,sama5d2-tcb", .data = &tcb_sama5d2_config, }, 288106b1041SKamel Bouhara { .compatible = "atmel,sama5d3-tcb", .data = &tcb_sama5d3_config, }, 289106b1041SKamel Bouhara { /* sentinel */ } 290106b1041SKamel Bouhara }; 291106b1041SKamel Bouhara 292106b1041SKamel Bouhara static void mchp_tc_clk_remove(void *ptr) 293106b1041SKamel Bouhara { 294106b1041SKamel Bouhara clk_disable_unprepare((struct clk *)ptr); 295106b1041SKamel Bouhara } 296106b1041SKamel Bouhara 297106b1041SKamel Bouhara static int mchp_tc_probe(struct platform_device *pdev) 298106b1041SKamel Bouhara { 299106b1041SKamel Bouhara struct device_node *np = pdev->dev.of_node; 300106b1041SKamel Bouhara const struct atmel_tcb_config *tcb_config; 301106b1041SKamel Bouhara const struct of_device_id *match; 302106b1041SKamel Bouhara struct mchp_tc_data *priv; 303106b1041SKamel Bouhara char clk_name[7]; 304106b1041SKamel Bouhara struct regmap *regmap; 305106b1041SKamel Bouhara struct clk *clk[3]; 306106b1041SKamel Bouhara int channel; 307106b1041SKamel Bouhara int ret, i; 308106b1041SKamel Bouhara 309106b1041SKamel Bouhara priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); 310106b1041SKamel Bouhara if (!priv) 311106b1041SKamel Bouhara return -ENOMEM; 312106b1041SKamel Bouhara 313106b1041SKamel Bouhara platform_set_drvdata(pdev, priv); 314106b1041SKamel Bouhara 315106b1041SKamel Bouhara match = of_match_node(atmel_tc_of_match, np->parent); 316106b1041SKamel Bouhara tcb_config = match->data; 317106b1041SKamel Bouhara if (!tcb_config) { 318106b1041SKamel Bouhara dev_err(&pdev->dev, "No matching parent node found\n"); 319106b1041SKamel Bouhara return -ENODEV; 320106b1041SKamel Bouhara } 321106b1041SKamel Bouhara 322106b1041SKamel Bouhara regmap = syscon_node_to_regmap(np->parent); 323106b1041SKamel Bouhara if (IS_ERR(priv->regmap)) 324106b1041SKamel Bouhara return PTR_ERR(priv->regmap); 325106b1041SKamel Bouhara 326106b1041SKamel Bouhara /* max. channels number is 2 when in QDEC mode */ 327106b1041SKamel Bouhara priv->num_channels = of_property_count_u32_elems(np, "reg"); 328106b1041SKamel Bouhara if (priv->num_channels < 0) { 329106b1041SKamel Bouhara dev_err(&pdev->dev, "Invalid or missing channel\n"); 330106b1041SKamel Bouhara return -EINVAL; 331106b1041SKamel Bouhara } 332106b1041SKamel Bouhara 333106b1041SKamel Bouhara /* Register channels and initialize clocks */ 334106b1041SKamel Bouhara for (i = 0; i < priv->num_channels; i++) { 335106b1041SKamel Bouhara ret = of_property_read_u32_index(np, "reg", i, &channel); 336106b1041SKamel Bouhara if (ret < 0 || channel > 2) 337106b1041SKamel Bouhara return -ENODEV; 338106b1041SKamel Bouhara 339106b1041SKamel Bouhara priv->channel[i] = channel; 340106b1041SKamel Bouhara 341106b1041SKamel Bouhara snprintf(clk_name, sizeof(clk_name), "t%d_clk", channel); 342106b1041SKamel Bouhara 343106b1041SKamel Bouhara clk[i] = of_clk_get_by_name(np->parent, clk_name); 344106b1041SKamel Bouhara if (IS_ERR(clk[i])) { 345106b1041SKamel Bouhara /* Fallback to t0_clk */ 346106b1041SKamel Bouhara clk[i] = of_clk_get_by_name(np->parent, "t0_clk"); 347106b1041SKamel Bouhara if (IS_ERR(clk[i])) 348106b1041SKamel Bouhara return PTR_ERR(clk[i]); 349106b1041SKamel Bouhara } 350106b1041SKamel Bouhara 351106b1041SKamel Bouhara ret = clk_prepare_enable(clk[i]); 352106b1041SKamel Bouhara if (ret) 353106b1041SKamel Bouhara return ret; 354106b1041SKamel Bouhara 355106b1041SKamel Bouhara ret = devm_add_action_or_reset(&pdev->dev, 356106b1041SKamel Bouhara mchp_tc_clk_remove, 357106b1041SKamel Bouhara clk[i]); 358106b1041SKamel Bouhara if (ret) 359106b1041SKamel Bouhara return ret; 360106b1041SKamel Bouhara 361106b1041SKamel Bouhara dev_dbg(&pdev->dev, 362106b1041SKamel Bouhara "Initialized capture mode on channel %d\n", 363106b1041SKamel Bouhara channel); 364106b1041SKamel Bouhara } 365106b1041SKamel Bouhara 366106b1041SKamel Bouhara priv->tc_cfg = tcb_config; 367106b1041SKamel Bouhara priv->regmap = regmap; 368106b1041SKamel Bouhara priv->counter.name = dev_name(&pdev->dev); 369106b1041SKamel Bouhara priv->counter.parent = &pdev->dev; 370106b1041SKamel Bouhara priv->counter.ops = &mchp_tc_ops; 371106b1041SKamel Bouhara priv->counter.num_counts = ARRAY_SIZE(mchp_tc_counts); 372106b1041SKamel Bouhara priv->counter.counts = mchp_tc_counts; 373106b1041SKamel Bouhara priv->counter.num_signals = ARRAY_SIZE(mchp_tc_count_signals); 374106b1041SKamel Bouhara priv->counter.signals = mchp_tc_count_signals; 375106b1041SKamel Bouhara priv->counter.priv = priv; 376106b1041SKamel Bouhara 377106b1041SKamel Bouhara return devm_counter_register(&pdev->dev, &priv->counter); 378106b1041SKamel Bouhara } 379106b1041SKamel Bouhara 380106b1041SKamel Bouhara static const struct of_device_id mchp_tc_dt_ids[] = { 381106b1041SKamel Bouhara { .compatible = "microchip,tcb-capture", }, 382106b1041SKamel Bouhara { /* sentinel */ }, 383106b1041SKamel Bouhara }; 384106b1041SKamel Bouhara MODULE_DEVICE_TABLE(of, mchp_tc_dt_ids); 385106b1041SKamel Bouhara 386106b1041SKamel Bouhara static struct platform_driver mchp_tc_driver = { 387106b1041SKamel Bouhara .probe = mchp_tc_probe, 388106b1041SKamel Bouhara .driver = { 389106b1041SKamel Bouhara .name = "microchip-tcb-capture", 390106b1041SKamel Bouhara .of_match_table = mchp_tc_dt_ids, 391106b1041SKamel Bouhara }, 392106b1041SKamel Bouhara }; 393106b1041SKamel Bouhara module_platform_driver(mchp_tc_driver); 394106b1041SKamel Bouhara 395106b1041SKamel Bouhara MODULE_AUTHOR("Kamel Bouhara <kamel.bouhara@bootlin.com>"); 396106b1041SKamel Bouhara MODULE_DESCRIPTION("Microchip TCB Capture driver"); 397106b1041SKamel Bouhara MODULE_LICENSE("GPL v2"); 398