Re: [PATCH V7] hwmon: add fan/pwm driver for corsair h100i platinum

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On 9/7/20 11:01 AM, jaap aarts wrote:
> Hello guenter and/or Barnabás (+ others),
> 
> Sorry for me being slow on my last patch, since the previous reviews ware
> done within a week I just wanted to make sure this patch didnt slip under the
> radar.
> 
> Let me know if there is anything still to do, I couldnt find anything
> I needed to do
> on my end once everything is satisfying, but if there is some final step I would
> appreciate if you let me know what that would be.
> 

I have a number of concerns with your patch. Just to give a quick summary,

- I already mentioned a couple of times that the kernel is not in the business of defining
  fan curves. You eliminated nost, but one still remains.
- pwm_enable values 0 and 2 do the same. That neither makes sense nor is acceptable.
- There are various style issues with your code. checkpatch --strict will point to some
  of them, but there are others (such as goto to a label which just returns).
- check_succes() is quite ineffient (and, as I just noticed, misspelled).
- The method to acquire and release mutex and calling usb_autopm_get_interface()
  compared to releasing the same is inconsistent. It optimizes error handling over
  clean code, which doesn't really make much sense and makes the code both
  difficult to review and error prone, especially if changes are ever made in the
  future.
- The resume and suspend functions seem pretty pointless, since they are doing nothing.
- There are variuos unacceptable backtraces pointing to (and expecting) bugs in the code.
- At least some of the other messages, such as "setup hwmon for %s", are unaccpetable.
- Error handling is sometimes improperly implemented. The point of using goto for
  error handling is to have it in one place. Yet, there is repeated code such as
    if (error) {
        do_something;
        goto exit;
    }
    ...
exit:
    return;
which completely defeats the purpose of unified error handling.

There is more; this is just a start. Given the previous issues, where you kept
arguing about things like the semaphores until you realized yourself that it was buggy,
I'll have to explore each of those cases one by one and spend a lot of time convincing
you to consider changing your code. Unfortunately, I am severely time constraint and
just don't have the time to do that right now.

Guenter

> Kind redards,
> 
> Jaap Aarts
> 
> 
> On Sat, 22 Aug 2020 at 12:47, jaap aarts <jaap.aarts1@xxxxxxxxx> wrote:
>>
>> Adds fan/pwm support for H100i platinum.
>> Custom temp/fan curves are not supported.
>>
>> v7:
>>  - redo memory management with regards to device setup. (no more use after
>>    free, double frees, fixed sizeof)
>>  - add myself to MAINTAINERS
>>  - add documentation for this driver
>>
>> Signed-off-by: Jaap Aarts <jaap.aarts1@xxxxxxxxx>
>> ---
>>  Documentation/hwmon/corsair_hydro_i_pro.rst |  54 ++
>>  MAINTAINERS                                 |   6 +
>>  drivers/hwmon/Kconfig                       |   7 +
>>  drivers/hwmon/Makefile                      |   1 +
>>  drivers/hwmon/corsair_hydro_i_pro.c         | 719 ++++++++++++++++++++
>>  5 files changed, 787 insertions(+)
>>  create mode 100644 Documentation/hwmon/corsair_hydro_i_pro.rst
>>  create mode 100644 drivers/hwmon/corsair_hydro_i_pro.c
>>
>> diff --git a/Documentation/hwmon/corsair_hydro_i_pro.rst b/Documentation/hwmon/corsair_hydro_i_pro.rst
>> new file mode 100644
>> index 000000000000..17d90d1b8e33
>> --- /dev/null
>> +++ b/Documentation/hwmon/corsair_hydro_i_pro.rst
>> @@ -0,0 +1,54 @@
>> +.. SPDX-License-Identifier: GPL-2.0-or-later
>> +
>> +Kernel driver corsair_hydro_i_pro
>> +==========================
>> +
>> +Supported devices:
>> +
>> +  * Corsair H100i pro
>> +
>> +Author: Jaap Aarts
>> +
>> +Description
>> +-----------
>> +
>> +This driver implements the hwmon interface for the corsair H100i pro.
>> +Suppor for more All In One liquid coolers(AIOs) from this product range
>> +should be supported, only testing and a new config should be required.
>> +These AIOs can be controlled via USB, with control over fans, pumps, RGB
>> +lighting, and temperature sensors.
>> +Currently only fans are supported, but no custom fan curves are supported.
>> +There is always one pump and 1-3 fans.
>> +
>> +The H100i pro configuration:
>> +fans: 2
>> +minrpm: 200,
>> +maxrpm: 3000,
>> +maxpwm 100,
>> +device name: "corsair_H100i_pro",
>> +
>> +Usage Notes
>> +-----------
>> +
>> +Since it is a USB device, hotswapping is possible. The device is autodetected.
>> +
>> +Sysfs entries
>> +-------------
>> +
>> +======================= =====================================================================
>> +fan[1-2]_input         Connected fan rpm.
>> +fan[1-2]_target                Sets fan speed target rpm, when writing and if fan_mode is not
>> +                       set to one returns -EINVAL.
>> +                       When reading, it reports the last value if it was set by the driver.
>> +                       When the mode is not set to 1 (manual) read value will be 0.
>> +                       Otherwise returns an error.
>> +fan[1-2]_min           Reports the minimum rpm value. for the H100i pro this is 200
>> +fan[1-2]_max           Reports the maximum rpm value. for the H100i pro this is 3000
>> +
>> +pwm[1-2]                       Sets the fan speed. Values from 0-100, when writing and if
>> +                       fan_mode is not set to one returns -EINVAL.
>> +pwm[1-2]_enable                Set the mode for the fan.
>> +                       0: no fan speed control (i.e. default fan profile)
>> +                       1: manual fan control
>> +                       2: default fan profile
>> +======================= =====================================================================
>> diff --git a/MAINTAINERS b/MAINTAINERS
>> index f0068bceeb61..0e7553a0e2e5 100644
>> --- a/MAINTAINERS
>> +++ b/MAINTAINERS
>> @@ -4461,6 +4461,12 @@ L:       linux-hwmon@xxxxxxxxxxxxxxx
>>  S:     Maintained
>>  F:     drivers/hwmon/corsair-cpro.c
>>
>> +CORSAIR-HYDRO-I-PRO HARDWARE MONITOR DRIVER
>> +M:     Jaap Aarts <jaap.aarts1>@gmail.com>
>> +L:     linux-hwmon@xxxxxxxxxxxxxxx
>> +S:     Maintained
>> +F:     drivers/hwmon/corsair_hydro_i_pro.c
>> +
>>  COSA/SRP SYNC SERIAL DRIVER
>>  M:     Jan "Yenya" Kasprzak <kas@xxxxxxxxxx>
>>  S:     Maintained
>> diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig
>> index 8dc28b26916e..9a721659313f 100644
>> --- a/drivers/hwmon/Kconfig
>> +++ b/drivers/hwmon/Kconfig
>> @@ -378,6 +378,13 @@ config SENSORS_ARM_SCPI
>>           and power sensors available on ARM Ltd's SCP based platforms. The
>>           actual number and type of sensors exported depend on the platform.
>>
>> +config SENSORS_CORSAIR_HYDRO_I_PRO
>> +       tristate "Corsair hydro HXXXi pro driver"
>> +       depends on USB
>> +       help
>> +         If you say yes here you get support for the corsair hydro HXXXi pro
>> +         range of devices.
>> +
>>  config SENSORS_ASB100
>>         tristate "Asus ASB100 Bach"
>>         depends on X86 && I2C
>> diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile
>> index a8f4b35b136b..3bad054054fe 100644
>> --- a/drivers/hwmon/Makefile
>> +++ b/drivers/hwmon/Makefile
>> @@ -20,6 +20,7 @@ obj-$(CONFIG_SENSORS_W83793)  += w83793.o
>>  obj-$(CONFIG_SENSORS_W83795)   += w83795.o
>>  obj-$(CONFIG_SENSORS_W83781D)  += w83781d.o
>>  obj-$(CONFIG_SENSORS_W83791D)  += w83791d.o
>> +obj-$(CONFIG_SENSORS_CORSAIR_HYDRO_I_PRO)      += corsair_hydro_i_pro.o
>>
>>  obj-$(CONFIG_SENSORS_AB8500)   += abx500.o ab8500.o
>>  obj-$(CONFIG_SENSORS_ABITUGURU)        += abituguru.o
>> diff --git a/drivers/hwmon/corsair_hydro_i_pro.c b/drivers/hwmon/corsair_hydro_i_pro.c
>> new file mode 100644
>> index 000000000000..42869f32a7bd
>> --- /dev/null
>> +++ b/drivers/hwmon/corsair_hydro_i_pro.c
>> @@ -0,0 +1,719 @@
>> +// SPDX-License-Identifier: GPL-2.0-or-later
>> +/*
>> + * A hwmon driver for all corsair hyxro HXXXi pro all-in-one liquid coolers.
>> + * Copyright (c) Jaap Aarts 2020
>> + *
>> + * Protocol partially reverse engineered by audiohacked
>> + * https://github.com/audiohacked/OpendriverLink
>> + */
>> +
>> +/*
>> + * Supports following liquid coolers:
>> + * H100i platinum
>> + *
>> + * Other products should work with this driver with slight modification.
>> + *
>> + * Note: platinum is the codename name for pro within the driver, so H100i platinum = H100i pro.
>> + * But some products are actually called platinum, these are not intended to be supported (yet).
>> + *
>> + * Note: fan curve control has not been implemented
>> + */
>> +
>> +#include <linux/errno.h>
>> +#include <linux/hwmon.h>
>> +#include <linux/kernel.h>
>> +#include <linux/module.h>
>> +#include <linux/slab.h>
>> +#include <linux/usb.h>
>> +
>> +struct device_config {
>> +       const u16 vendor_id;
>> +       const u16 product_id;
>> +       const u8 fancount;
>> +       const u16 rpm_min;
>> +       const u16 rpm_max;
>> +       const u8 pwm_max;
>> +       const char *name;
>> +       const struct hwmon_channel_info **hwmon_info;
>> +};
>> +
>> +struct hydro_i_pro_device {
>> +       struct usb_device *udev;
>> +
>> +       const struct device_config *config;
>> +
>> +       unsigned char *bulk_out_buffer;
>> +       unsigned char *bulk_in_buffer;
>> +       size_t bulk_out_size;
>> +       size_t bulk_in_size;
>> +       char bulk_in_endpointAddr;
>> +       char bulk_out_endpointAddr;
>> +
>> +       struct usb_interface *interface; /* the interface for this device */
>> +       struct mutex io_mutex;
>> +};
>> +
>> +#define MAX_FAN_COUNT 2
>> +#define MAX_PWM_CHANNEL_COUNT MAX_FAN_COUNT
>> +
>> +struct hwmon_data {
>> +       struct hydro_i_pro_device *hdev;
>> +       u8 channel_count;
>> +       void *channel_data[MAX_PWM_CHANNEL_COUNT];
>> +};
>> +
>> +struct curve_point {
>> +       u8 temp;
>> +       u8 pwm;
>> +};
>> +
>> +#define FAN_CURVE_COUNT 7
>> +
>> +struct hwmon_fan_data {
>> +       u8 fan_channel;
>> +       u16 fan_target;
>> +       u8 fan_pwm_target;
>> +       u8 mode;
>> +       struct curve_point curve[FAN_CURVE_COUNT];
>> +};
>> +
>> +static struct curve_point quiet_curve[FAN_CURVE_COUNT] = {
>> +       {
>> +               .temp = 0x1F,
>> +               .pwm = 0x15,
>> +       },
>> +       {
>> +               .temp = 0x21,
>> +               .pwm = 0x1E,
>> +       },
>> +       {
>> +               .temp = 0x24,
>> +               .pwm = 0x25,
>> +       },
>> +       {
>> +               .temp = 0x27,
>> +               .pwm = 0x2D,
>> +       },
>> +       {
>> +               .temp = 0x29,
>> +               .pwm = 0x38,
>> +       },
>> +       {
>> +               .temp = 0x2C,
>> +               .pwm = 0x4A,
>> +       },
>> +       {
>> +               .temp = 0x2F,
>> +               .pwm = 0x64,
>> +       },
>> +};
>> +
>> +#define DEFAULT_CURVE quiet_curve
>> +
>> +static const struct hwmon_channel_info *dual_fan[] = {
>> +       HWMON_CHANNEL_INFO(
>> +               fan, HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_MIN | HWMON_F_MAX,
>> +               HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_MIN | HWMON_F_MAX),
>> +       HWMON_CHANNEL_INFO(pwm, HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
>> +                          HWMON_PWM_INPUT | HWMON_PWM_ENABLE),
>> +       NULL
>> +};
>> +
>> +static const struct device_config config_table[] = {
>> +       {
>> +               .fancount = 2,
>> +               .rpm_min = 200,
>> +               .rpm_max = 3000,
>> +               .pwm_max = 100,
>> +               .name = "corsair_H100i_pro",
>> +               .hwmon_info = dual_fan,
>> +       },
>> +};
>> +
>> +#define BULK_TIMEOUT 100
>> +
>> +enum opcodes {
>> +       PWM_FAN_CURVE_CMD = 0x40,
>> +       PWM_GET_CURRENT_CMD = 0x41,
>> +       PWM_FAN_TARGET_CMD = 0x42,
>> +       RPM_FAN_TARGET_CMD = 0x43,
>> +};
>> +
>> +#define SUCCES_LENGTH 3
>> +#define SUCCES_CODE 0x12, 0x34
>> +
>> +static bool check_succes(enum opcodes command, char ret[static SUCCES_LENGTH])
>> +{
>> +       char success[SUCCES_LENGTH] = { command, SUCCES_CODE };
>> +
>> +       return memcmp(ret, success, SUCCES_LENGTH) == 0;
>> +}
>> +
>> +static int acquire_lock(struct hydro_i_pro_device *hdev)
>> +{
>> +       int retval = usb_autopm_get_interface(hdev->interface);
>> +
>> +       if (retval)
>> +               return retval;
>> +
>> +       return mutex_lock_interruptible(&hdev->io_mutex);
>> +}
>> +
>> +static int transfer_usb(struct hydro_i_pro_device *hdev,
>> +                       unsigned char *send_buf, unsigned char *recv_buf,
>> +                       int send_len, int recv_len)
>> +{
>> +       int retval;
>> +       int wrote;
>> +       int sndpipe = usb_sndbulkpipe(hdev->udev, hdev->bulk_out_endpointAddr);
>> +       int rcvpipe = usb_rcvbulkpipe(hdev->udev, hdev->bulk_in_endpointAddr);
>> +
>> +       retval = usb_bulk_msg(hdev->udev, sndpipe, send_buf, send_len, &wrote,
>> +                             BULK_TIMEOUT);
>> +       if (retval)
>> +               return retval;
>> +       if (wrote != send_len)
>> +               return -EIO;
>> +
>> +       retval = usb_bulk_msg(hdev->udev, rcvpipe, recv_buf, recv_len, &wrote,
>> +                             BULK_TIMEOUT);
>> +       if (retval)
>> +               return retval;
>> +       if (wrote != recv_len)
>> +               return -EIO;
>> +
>> +       return 0;
>> +}
>> +
>> +static int set_fan_pwm_curve(struct hydro_i_pro_device *hdev,
>> +                            struct hwmon_fan_data *fan_data,
>> +                            struct curve_point point[static FAN_CURVE_COUNT])
>> +{
>> +       int retval;
>> +       unsigned char *send_buf = hdev->bulk_out_buffer;
>> +       unsigned char *recv_buf = hdev->bulk_in_buffer;
>> +
>> +       send_buf[0] = PWM_FAN_CURVE_CMD;
>> +       send_buf[1] = fan_data->fan_channel;
>> +       send_buf[2] = point[0].temp;
>> +       send_buf[3] = point[1].temp;
>> +       send_buf[4] = point[2].temp;
>> +       send_buf[5] = point[3].temp;
>> +       send_buf[6] = point[4].temp;
>> +       send_buf[7] = point[5].temp;
>> +       send_buf[8] = point[6].temp;
>> +       send_buf[9] = point[0].pwm;
>> +       send_buf[10] = point[1].pwm;
>> +       send_buf[11] = point[2].pwm;
>> +       send_buf[12] = point[3].pwm;
>> +       send_buf[13] = point[4].pwm;
>> +       send_buf[14] = point[5].pwm;
>> +       send_buf[15] = point[6].pwm;
>> +
>> +       retval = transfer_usb(hdev, send_buf, recv_buf, 16, 3);
>> +       if (retval)
>> +               return retval;
>> +
>> +       if (!check_succes(send_buf[0], recv_buf)) {
>> +               dev_warn(
>> +                       &hdev->udev->dev,
>> +                       "failed setting fan pwm/temp curve for %s on channel %d %d,%d,%d\n",
>> +                       hdev->config->name, fan_data->fan_channel, recv_buf[0],
>> +                       recv_buf[1], recv_buf[2]);
>> +               return -EINVAL;
>> +       }
>> +
>> +       memcpy(fan_data->curve, point, sizeof(fan_data->curve));
>> +
>> +       return 0;
>> +}
>> +
>> +static int set_fan_target_rpm(struct hydro_i_pro_device *hdev,
>> +                             struct hwmon_fan_data *fan_data, u16 val)
>> +{
>> +       int retval;
>> +       unsigned char *send_buf = hdev->bulk_out_buffer;
>> +       unsigned char *recv_buf = hdev->bulk_in_buffer;
>> +
>> +       send_buf[0] = RPM_FAN_TARGET_CMD;
>> +       send_buf[1] = fan_data->fan_channel;
>> +       send_buf[2] = (val >> 8);
>> +       send_buf[3] = val;
>> +
>> +       retval = transfer_usb(hdev, send_buf, recv_buf, 4, 3);
>> +       if (retval)
>> +               return retval;
>> +
>> +       if (!check_succes(send_buf[0], recv_buf)) {
>> +               dev_warn(
>> +                       &hdev->udev->dev,
>> +                       "failed setting fan rpm for %s on channel %d %d,%d,%d\n",
>> +                       hdev->config->name, fan_data->fan_channel, recv_buf[0],
>> +                       recv_buf[1], recv_buf[2]);
>> +               return -EINVAL;
>> +       }
>> +       fan_data->fan_target = val;
>> +       fan_data->fan_pwm_target = 0;
>> +
>> +       return 0;
>> +}
>> +
>> +static int get_fan_current_rpm(struct hydro_i_pro_device *hdev,
>> +                              struct hwmon_fan_data *fan_data, long *val)
>> +{
>> +       int retval;
>> +       unsigned char *send_buf = hdev->bulk_out_buffer;
>> +       unsigned char *recv_buf = hdev->bulk_in_buffer;
>> +
>> +       send_buf[0] = PWM_GET_CURRENT_CMD;
>> +       send_buf[1] = fan_data->fan_channel;
>> +
>> +       retval = transfer_usb(hdev, send_buf, recv_buf, 2, 6);
>> +       if (retval)
>> +               return retval;
>> +
>> +       if (!check_succes(send_buf[0], recv_buf) ||
>> +           recv_buf[3] != fan_data->fan_channel) {
>> +               dev_warn(
>> +                       &hdev->udev->dev,
>> +                       "failed retrieving fan pwm for %s on channel %d %d,%d,%d/%d\n",
>> +                       hdev->config->name, fan_data->fan_channel, recv_buf[0],
>> +                       recv_buf[1], recv_buf[2], recv_buf[3]);
>> +               return -EINVAL;
>> +       }
>> +
>> +       *val = ((recv_buf[4]) << 8) + recv_buf[5];
>> +       return 0;
>> +}
>> +
>> +static int set_fan_target_pwm(struct hydro_i_pro_device *hdev,
>> +                             struct hwmon_fan_data *fan_data, u8 val)
>> +{
>> +       int retval;
>> +       unsigned char *send_buf = hdev->bulk_out_buffer;
>> +       unsigned char *recv_buf = hdev->bulk_in_buffer;
>> +
>> +       send_buf[0] = PWM_FAN_TARGET_CMD;
>> +       send_buf[1] = fan_data->fan_channel;
>> +       send_buf[2] = val;
>> +
>> +       retval = transfer_usb(hdev, send_buf, recv_buf, 3, 3);
>> +       if (retval)
>> +               return retval;
>> +
>> +       if (!check_succes(send_buf[0], recv_buf)) {
>> +               dev_warn(
>> +                       &hdev->udev->dev,
>> +                       "failed setting fan pwm for %s on channel %d %d,%d,%d\n",
>> +                       hdev->config->name, fan_data->fan_channel, recv_buf[0],
>> +                       recv_buf[1], recv_buf[2]);
>> +               return -EINVAL;
>> +       }
>> +       fan_data->fan_target = 0;
>> +       fan_data->fan_pwm_target = val;
>> +
>> +       return 0;
>> +}
>> +
>> +static umode_t hwmon_is_visible(const void *d, enum hwmon_sensor_types type,
>> +                               u32 attr, int channel)
>> +{
>> +       switch (type) {
>> +       case hwmon_fan:
>> +               switch (attr) {
>> +               case hwmon_fan_input:
>> +                       return 0444;
>> +               case hwmon_fan_target:
>> +                       return 0644;
>> +               case hwmon_fan_min:
>> +                       return 0444;
>> +               case hwmon_fan_max:
>> +                       return 0444;
>> +               default:
>> +                       break;
>> +               }
>> +               break;
>> +       case hwmon_pwm:
>> +               switch (attr) {
>> +               case hwmon_pwm_input:
>> +                       return 0200;
>> +               case hwmon_pwm_enable:
>> +                       return 0644;
>> +               default:
>> +                       break;
>> +               }
>> +               break;
>> +       default:
>> +               break;
>> +       }
>> +       return 0;
>> +}
>> +
>> +static int hwmon_write(struct device *dev, enum hwmon_sensor_types type,
>> +                      u32 attr, int channel, long val)
>> +{
>> +       struct hwmon_data *data = dev_get_drvdata(dev);
>> +       struct hydro_i_pro_device *hdev = data->hdev;
>> +       struct hwmon_fan_data *fan_data;
>> +       int retval = 0;
>> +
>> +       switch (type) {
>> +       case hwmon_fan:
>> +               switch (attr) {
>> +               case hwmon_fan_target:
>> +                       fan_data = data->channel_data[channel];
>> +                       if (fan_data->mode != 1)
>> +                               return -EINVAL;
>> +
>> +                       val = clamp_val(val, hdev->config->rpm_min,
>> +                                       hdev->config->rpm_max);
>> +
>> +                       retval = acquire_lock(hdev);
>> +                       if (retval)
>> +                               goto exit;
>> +
>> +                       retval = set_fan_target_rpm(hdev, fan_data, val);
>> +                       if (retval)
>> +                               goto cleanup;
>> +
>> +                       break;
>> +               default:
>> +                       return -EINVAL;
>> +               }
>> +               break;
>> +       case hwmon_pwm:
>> +               switch (attr) {
>> +               case hwmon_pwm_input:
>> +                       fan_data = data->channel_data[channel];
>> +                       if (fan_data->mode != 1)
>> +                               return -EINVAL;
>> +
>> +                       val = clamp_val(val, 0, hdev->config->pwm_max);
>> +                       retval = acquire_lock(hdev);
>> +                       if (retval)
>> +                               goto exit;
>> +
>> +                       retval = set_fan_target_pwm(hdev, fan_data, val);
>> +                       if (retval)
>> +                               goto cleanup;
>> +
>> +                       break;
>> +               case hwmon_pwm_enable:
>> +                       fan_data = data->channel_data[channel];
>> +
>> +                       switch (val) {
>> +                       case 2:
>> +                       case 0:
>> +                               retval = acquire_lock(hdev);
>> +                               if (retval)
>> +                                       goto exit;
>> +
>> +                               retval = set_fan_pwm_curve(hdev, fan_data,
>> +                                                          DEFAULT_CURVE);
>> +                               if (retval)
>> +                                       goto cleanup;
>> +                               fan_data->mode = val;
>> +                               break;
>> +                       case 1:
>> +                               retval = acquire_lock(hdev);
>> +                               if (retval)
>> +                                       goto exit;
>> +
>> +                               if (fan_data->fan_target != 0) {
>> +                                       retval = set_fan_target_rpm(
>> +                                               hdev, fan_data,
>> +                                               fan_data->fan_target);
>> +                                       if (retval)
>> +                                               goto cleanup;
>> +                               } else if (fan_data->fan_pwm_target != 0) {
>> +                                       retval = set_fan_target_pwm(
>> +                                               hdev, fan_data,
>> +                                               fan_data->fan_pwm_target);
>> +                                       if (retval)
>> +                                               goto cleanup;
>> +                               }
>> +                               fan_data->mode = 1;
>> +                               break;
>> +                       default:
>> +                               return -EINVAL;
>> +                       }
>> +                       break;
>> +               default:
>> +                       return -EINVAL;
>> +               }
>> +               break;
>> +       default:
>> +               return -EINVAL;
>> +       }
>> +
>> +cleanup:
>> +       mutex_unlock(&hdev->io_mutex);
>> +       usb_autopm_put_interface(hdev->interface);
>> +exit:
>> +       return retval;
>> +}
>> +
>> +static int hwmon_read(struct device *dev, enum hwmon_sensor_types type,
>> +                     u32 attr, int channel, long *val)
>> +{
>> +       struct hwmon_data *data = dev_get_drvdata(dev);
>> +       struct hydro_i_pro_device *hdev = data->hdev;
>> +       struct hwmon_fan_data *fan_data;
>> +       int retval = 0;
>> +
>> +       switch (type) {
>> +       case hwmon_fan:
>> +               switch (attr) {
>> +               case hwmon_fan_input:
>> +                       fan_data = data->channel_data[channel];
>> +
>> +                       retval = acquire_lock(hdev);
>> +                       if (retval)
>> +                               goto exit;
>> +
>> +                       retval = get_fan_current_rpm(hdev, fan_data, val);
>> +                       break;
>> +               case hwmon_fan_target:
>> +                       fan_data = data->channel_data[channel];
>> +                       if (fan_data->mode != 1) {
>> +                               *val = 0;
>> +                               goto exit;
>> +                       }
>> +                       *val = fan_data->fan_target;
>> +                       goto exit;
>> +               case hwmon_fan_min:
>> +                       *val = hdev->config->rpm_min;
>> +                       goto exit;
>> +               case hwmon_fan_max:
>> +                       *val = hdev->config->rpm_max;
>> +                       goto exit;
>> +
>> +               default:
>> +                       return -EINVAL;
>> +               }
>> +               break;
>> +       case hwmon_pwm:
>> +               switch (attr) {
>> +               case hwmon_pwm_enable:
>> +                       fan_data = data->channel_data[channel];
>> +                       *val = fan_data->mode;
>> +                       goto exit;
>> +               default:
>> +                       return -EINVAL;
>> +               }
>> +               goto exit;
>> +
>> +       default:
>> +               return -EINVAL;
>> +       }
>> +
>> +       mutex_unlock(&hdev->io_mutex);
>> +       usb_autopm_put_interface(hdev->interface);
>> +exit:
>> +       return retval;
>> +}
>> +
>> +static const struct hwmon_ops i_pro_ops = {
>> +       .is_visible = hwmon_is_visible,
>> +       .read = hwmon_read,
>> +       .write = hwmon_write,
>> +};
>> +
>> +static int hwmon_init(struct hydro_i_pro_device *hdev)
>> +{
>> +       u8 fan_id;
>> +       struct device *hwmon_dev;
>> +       struct hwmon_fan_data *fan;
>> +       struct hwmon_data *data;
>> +       struct hwmon_chip_info *hwmon_info;
>> +
>> +       data = devm_kzalloc(&hdev->udev->dev, sizeof(*data), GFP_KERNEL);
>> +       if (!data)
>> +               return -ENOMEM;
>> +       hwmon_info =
>> +               devm_kzalloc(&hdev->udev->dev, sizeof(*hwmon_info), GFP_KERNEL);
>> +       if (!hwmon_info) {
>> +               devm_kfree(&hdev->udev->dev, data);
>> +               return -ENOMEM;
>> +       }
>> +
>> +       /* You did something bad!! Either adjust  MAX_FAN_COUNT or the fancount for the config!*/
>> +       WARN_ON(hdev->config->fancount >= MAX_PWM_CHANNEL_COUNT);
>> +       data->channel_count =
>> +               clamp_val(hdev->config->fancount, 0, MAX_PWM_CHANNEL_COUNT);
>> +
>> +       /* For each fan create a data channel a fan config entry and a pwm config entry */
>> +       for (fan_id = 0; fan_id < data->channel_count; fan_id++) {
>> +               fan = devm_kzalloc(&hdev->udev->dev, sizeof(fan), GFP_KERNEL);
>> +               if (!fan)
>> +                       return -ENOMEM;
>> +
>> +               fan->fan_channel = fan_id;
>> +               fan->mode = 0;
>> +               data->channel_data[fan_id] = fan;
>> +       }
>> +
>> +       hwmon_info->ops = &i_pro_ops;
>> +       hwmon_info->info = hdev->config->hwmon_info;
>> +
>> +       data->hdev = hdev;
>> +       hwmon_dev = devm_hwmon_device_register_with_info(
>> +               &hdev->udev->dev, hdev->config->name, data, hwmon_info, NULL);
>> +       if (IS_ERR(hwmon_dev))
>> +               return PTR_ERR(hwmon_dev);
>> +
>> +       dev_info(&hdev->udev->dev, "setup hwmon for %s\n", hdev->config->name);
>> +       return 0;
>> +}
>> +
>> +#define USB_VENDOR_ID_CORSAIR 0x1b1c
>> +#define USB_PRODUCT_ID_H100I_PRO 0x0c15
>> +/*
>> + * Devices that work with this driver.
>> + * More devices should work, however none have been tested.
>> + */
>> +static const struct usb_device_id astk_table[] = {
>> +       { USB_DEVICE(USB_VENDOR_ID_CORSAIR, USB_PRODUCT_ID_H100I_PRO),
>> +         .driver_info = (kernel_ulong_t)&config_table[0] },
>> +       {},
>> +};
>> +
>> +MODULE_DEVICE_TABLE(usb, astk_table);
>> +
>> +static int init_device(struct usb_device *udev)
>> +{
>> +       int retval;
>> +
>> +       /*
>> +        * This is needed because when running windows in a vm with proprietary driver
>> +        * and you switch to this driver, the device will not respond unless you run this.
>> +        */
>> +       retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x00, 0x40,
>> +                                0xffff, 0x0000, 0, 0, 0);
>> +
>> +       /*this always returns error, but it required for propper initialisation*/
>> +       if (retval != -EPIPE)
>> +               return retval;
>> +
>> +       return usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x02, 0x40,
>> +                              0x0002, 0x0000, 0, 0, 0);
>> +}
>> +
>> +static int deinit_device(struct usb_device *udev)
>> +{
>> +       return usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x02, 0x40,
>> +                              0x0004, 0x0000, 0, 0, 0);
>> +}
>> +
>> +static void astk_delete(struct hydro_i_pro_device *hdev)
>> +{
>> +       usb_put_intf(hdev->interface);
>> +       mutex_destroy(&hdev->io_mutex);
>> +       usb_put_dev(hdev->udev);
>> +}
>> +
>> +static int astk_probe(struct usb_interface *interface,
>> +                     const struct usb_device_id *id)
>> +{
>> +       struct usb_device *udev = usb_get_dev(interface_to_usbdev(interface));
>> +       struct hydro_i_pro_device *hdev;
>> +       int retval;
>> +       struct usb_endpoint_descriptor *bulk_in, *bulk_out;
>> +
>> +       hdev = devm_kzalloc(&udev->dev, sizeof(*hdev), GFP_KERNEL);
>> +
>> +       if (!hdev) {
>> +               retval = -ENOMEM;
>> +               goto exit;
>> +       }
>> +
>> +       hdev->config = (const struct device_config *)id->driver_info;
>> +       /* You should set the driver_info to a pointer to the correct configuration!!*/
>> +       WARN_ON(!hdev->config);
>> +
>> +       hdev->udev = udev;
>> +       hdev->interface = usb_get_intf(interface);
>> +       mutex_init(&hdev->io_mutex);
>> +
>> +       retval = usb_find_common_endpoints(interface->cur_altsetting, &bulk_in,
>> +                                          &bulk_out, NULL, NULL);
>> +       if (retval) {
>> +               astk_delete(hdev);
>> +               goto exit;
>> +       }
>> +
>> +       /*
>> +        * set up the endpoint information
>> +        * use only the first bulk-in and bulk-out endpoints
>> +        */
>> +       hdev->bulk_in_size = usb_endpoint_maxp(bulk_in);
>> +       hdev->bulk_in_buffer =
>> +               devm_kzalloc(&hdev->udev->dev, hdev->bulk_in_size, GFP_KERNEL);
>> +       hdev->bulk_in_endpointAddr = bulk_in->bEndpointAddress;
>> +       if (!hdev->bulk_in_buffer) {
>> +               astk_delete(hdev);
>> +               goto exit;
>> +       }
>> +
>> +       hdev->bulk_out_size = usb_endpoint_maxp(bulk_out);
>> +       hdev->bulk_out_buffer =
>> +               devm_kzalloc(&hdev->udev->dev, hdev->bulk_out_size, GFP_KERNEL);
>> +       hdev->bulk_out_endpointAddr = bulk_out->bEndpointAddress;
>> +       if (!hdev->bulk_out_buffer) {
>> +               astk_delete(hdev);
>> +               goto exit;
>> +       }
>> +
>> +       retval = init_device(hdev->udev);
>> +       if (retval) {
>> +               astk_delete(hdev);
>> +               goto exit;
>> +       }
>> +
>> +       retval = hwmon_init(hdev);
>> +       if (retval) {
>> +               astk_delete(hdev);
>> +               goto exit;
>> +       }
>> +
>> +       usb_set_intfdata(interface, hdev);
>> +exit:
>> +       return retval;
>> +}
>> +
>> +static void astk_disconnect(struct usb_interface *interface)
>> +{
>> +       struct hydro_i_pro_device *hdev = usb_get_intfdata(interface);
>> +
>> +       dev_info(&hdev->udev->dev, "removed hwmon for %s\n",
>> +                hdev->config->name);
>> +       deinit_device(hdev->udev);
>> +       usb_set_intfdata(interface, NULL);
>> +       astk_delete(hdev);
>> +}
>> +
>> +static int astk_resume(struct usb_interface *intf)
>> +{
>> +       return 0;
>> +}
>> +
>> +static int astk_suspend(struct usb_interface *intf, pm_message_t message)
>> +{
>> +       return 0;
>> +}
>> +
>> +static struct usb_driver hydro_i_pro_driver = {
>> +       .name = "hydro_i_pro_device",
>> +       .id_table = astk_table,
>> +       .probe = astk_probe,
>> +       .disconnect = astk_disconnect,
>> +       .resume = astk_resume,
>> +       .suspend = astk_suspend,
>> +       .supports_autosuspend = 1,
>> +};
>> +
>> +module_usb_driver(hydro_i_pro_driver);
>> +
>> +MODULE_LICENSE("GPL");
>> +MODULE_AUTHOR("Jaap Aarts <jaap.aarts1@xxxxxxxxx>");
>> +MODULE_DESCRIPTION("Corsair HXXXi pro device driver");
>> --
>> 2.28.0
>>




[Index of Archives]     [Linux Media]     [Linux Input]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Old Linux USB Devel Archive]

  Powered by Linux