Commit 221819ca authored by Patrick Rudolph's avatar Patrick Rudolph Committed by Guenter Roeck
Browse files

hwmon: (pmbus/core) Add interrupt support 



Implement PMBUS irq handler.

Signed-off-by: default avatarPatrick Rudolph <patrick.rudolph@9elements.com>
Signed-off-by: default avatarNaresh Solanki <naresh.solanki@9elements.com>
Link: https://lore.kernel.org/r/20230301164434.1928237-3-Naresh.Solanki@9elements.com


Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent df5f6b6a

drivers/hwmon/pmbus/pmbus.h

+1 −1
Original line number Diff line number Diff line
@@ -26,7 +26,7 @@ enum pmbus_regs { 


	PMBUS_CAPABILITY		= 0x19,

	PMBUS_QUERY			= 0x1A,



	PMBUS_SMBALERT_MASK		= 0x1B,

	PMBUS_VOUT_MODE			= 0x20,

	PMBUS_VOUT_COMMAND		= 0x21,

	PMBUS_VOUT_TRIM			= 0x22,

drivers/hwmon/pmbus/pmbus_core.c

+70 −0
Original line number Diff line number Diff line
@@ -3105,6 +3105,72 @@ static int pmbus_regulator_register(struct pmbus_data *data) 
}

#endif



static int pmbus_write_smbalert_mask(struct i2c_client *client, u8 page, u8 reg, u8 val)

{

	return pmbus_write_word_data(client, page, PMBUS_SMBALERT_MASK, reg | (val << 8));

}



static irqreturn_t pmbus_fault_handler(int irq, void *pdata)

{

	struct pmbus_data *data = pdata;

	struct i2c_client *client = to_i2c_client(data->dev);



	mutex_lock(&data->update_lock);

	/* TODO: Check status flag & notify hwmon events */



	pmbus_clear_faults(client);

	mutex_unlock(&data->update_lock);



	return IRQ_HANDLED;

}



static int pmbus_irq_setup(struct i2c_client *client, struct pmbus_data *data)

{

	struct device *dev = &client->dev;

	const struct pmbus_status_category *cat;

	const struct pmbus_status_assoc *bit;

	int i, j, err, func;

	u8 mask;



	static const u8 misc_status[] = {PMBUS_STATUS_CML, PMBUS_STATUS_OTHER,

					 PMBUS_STATUS_MFR_SPECIFIC, PMBUS_STATUS_FAN_12,

					 PMBUS_STATUS_FAN_34};



	if (!client->irq)

		return 0;



	for (i = 0; i < data->info->pages; i++) {

		func = data->info->func[i];



		for (j = 0; j < ARRAY_SIZE(pmbus_status_flag_map); j++) {

			cat = &pmbus_status_flag_map[j];

			if (!(func & cat->func))

				continue;

			mask = 0;

			for (bit = cat->bits; bit->pflag; bit++)

				mask |= bit->pflag;



			err = pmbus_write_smbalert_mask(client, i, cat->reg, ~mask);

			if (err)

				dev_dbg_once(dev, "Failed to set smbalert for reg 0x%02x\n",

					     cat->reg);

		}



		for (j = 0; j < ARRAY_SIZE(misc_status); j++)

			pmbus_write_smbalert_mask(client, i, misc_status[j], 0xff);

	}



	/* Register notifiers */

	err = devm_request_threaded_irq(dev, client->irq, NULL, pmbus_fault_handler, 0,

					"pmbus-irq", data);

	if (err) {

		dev_err(dev, "failed to request an irq %d\n", err);

		return err;

	}



	return 0;

}



static struct dentry *pmbus_debugfs_dir;	/* pmbus debugfs directory */



#if IS_ENABLED(CONFIG_DEBUG_FS)
@@ -3467,6 +3533,10 @@ int pmbus_do_probe(struct i2c_client *client, struct pmbus_driver_info *info) 
	if (ret)

		return ret;



	ret = pmbus_irq_setup(client, data);

	if (ret)

		return ret;



	ret = pmbus_init_debugfs(client, data);

	if (ret)

		dev_warn(dev, "Failed to register debugfs\n");