// SPDX-License-Identifier: GPL-2.0-only /* Copyright (C) 2023 Hewlett-Packard Enterprise Development Company, L.P. */ #include #include #include #include #include struct gxp_fan_ctrl_drvdata { void __iomem *base; }; static int gxp_pwm_write(struct device *dev, u32 attr, int channel, long val) { struct gxp_fan_ctrl_drvdata *drvdata = dev_get_drvdata(dev); switch (attr) { case hwmon_pwm_input: if (val > 255 || val < 0) return -EINVAL; writeb(val, drvdata->base + channel); return 0; default: return -EOPNOTSUPP; } } static int gxp_fan_ctrl_write(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel, long val) { switch (type) { case hwmon_pwm: return gxp_pwm_write(dev, attr, channel, val); default: return -EOPNOTSUPP; } } static int gxp_pwm_read(struct device *dev, u32 attr, int channel, long *val) { struct gxp_fan_ctrl_drvdata *drvdata = dev_get_drvdata(dev); *val = readb(drvdata->base + channel); return 0; } static int gxp_fan_ctrl_read(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel, long *val) { switch (type) { case hwmon_pwm: return gxp_pwm_read(dev, attr, channel, val); default: return -EOPNOTSUPP; } } static umode_t gxp_fan_ctrl_is_visible(const void *_data, enum hwmon_sensor_types type, u32 attr, int channel) { umode_t mode = 0; switch (type) { case hwmon_pwm: switch (attr) { case hwmon_pwm_input: mode = 0644; break; default: break; } break; default: break; } return mode; } static const struct hwmon_ops gxp_fan_ctrl_ops = { .is_visible = gxp_fan_ctrl_is_visible, .read = gxp_fan_ctrl_read, .write = gxp_fan_ctrl_write, }; static const struct hwmon_channel_info * const gxp_fan_ctrl_info[] = { HWMON_CHANNEL_INFO(pwm, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT, HWMON_PWM_INPUT), NULL }; static const struct hwmon_chip_info gxp_fan_ctrl_chip_info = { .ops = &gxp_fan_ctrl_ops, .info = gxp_fan_ctrl_info, }; static int gxp_fan_ctrl_probe(struct platform_device *pdev) { struct gxp_fan_ctrl_drvdata *drvdata; struct device *dev = &pdev->dev; struct device *hwmon_dev; drvdata = devm_kzalloc(dev, sizeof(struct gxp_fan_ctrl_drvdata), GFP_KERNEL); if (!drvdata) return -ENOMEM; drvdata->base = devm_platform_get_and_ioremap_resource(pdev, 0, NULL); if (IS_ERR(drvdata->base)) return dev_err_probe(dev, PTR_ERR(drvdata->base), "failed to map base\n"); hwmon_dev = devm_hwmon_device_register_with_info(&pdev->dev, "hpe_gxp_fan_ctrl", drvdata, &gxp_fan_ctrl_chip_info, NULL); return PTR_ERR_OR_ZERO(hwmon_dev); } static const struct of_device_id gxp_fan_ctrl_of_match[] = { { .compatible = "hpe,gxp-fan-ctrl", }, {}, }; MODULE_DEVICE_TABLE(of, gxp_fan_ctrl_of_match); static struct platform_driver gxp_fan_ctrl_driver = { .probe = gxp_fan_ctrl_probe, .driver = { .name = "gxp-fan-ctrl", .of_match_table = gxp_fan_ctrl_of_match, }, }; module_platform_driver(gxp_fan_ctrl_driver); MODULE_AUTHOR("Nick Hawkins "); MODULE_DESCRIPTION("HPE GXP fan controller"); MODULE_LICENSE("GPL");