Re: [PATCH 3/4] iccsense: split sensor into own struct

[Martin Peres <martin.peres-GANU6spQydw@public.gmane.org>]

On 25/03/16 13:19, Karol Herbst wrote:
> Signed-off-by: Karol Herbst <nouveau@karolherbst.de>
> ---
>   drm/nouveau/include/nvkm/subdev/iccsense.h |   1 +
>   drm/nouveau/nvkm/subdev/iccsense/base.c    | 141 ++++++++++++++++++++---------
>   drm/nouveau/nvkm/subdev/iccsense/priv.h    |  15 ++-
>   3 files changed, 112 insertions(+), 45 deletions(-)
>
> diff --git a/drm/nouveau/include/nvkm/subdev/iccsense.h b/drm/nouveau/include/nvkm/subdev/iccsense.h
> index a4c0da0..3c2ddd9 100644
> --- a/drm/nouveau/include/nvkm/subdev/iccsense.h
> +++ b/drm/nouveau/include/nvkm/subdev/iccsense.h
> @@ -6,6 +6,7 @@
>   struct nvkm_iccsense {
>   	struct nvkm_subdev subdev;
>   	bool data_valid;
> +	struct list_head sensors;
>   	struct list_head rails;
>   };
>   
> diff --git a/drm/nouveau/nvkm/subdev/iccsense/base.c b/drm/nouveau/nvkm/subdev/iccsense/base.c
> index 6fde68d..b6f6222 100644
> --- a/drm/nouveau/nvkm/subdev/iccsense/base.c
> +++ b/drm/nouveau/nvkm/subdev/iccsense/base.c
> @@ -30,15 +30,14 @@
>   
>   static bool
>   nvkm_iccsense_validate_device(struct i2c_adapter *i2c, u8 addr,
> -			      enum nvbios_extdev_type type, u8 rail)
> +			      enum nvbios_extdev_type type)
>   {
>   	switch (type) {
>   	case NVBIOS_EXTDEV_INA209:
>   	case NVBIOS_EXTDEV_INA219:
> -		return rail == 0 && nv_rd16i2cr(i2c, addr, 0x0) >= 0;
> +		return nv_rd16i2cr(i2c, addr, 0x0) >= 0;
>   	case NVBIOS_EXTDEV_INA3221:
> -		return rail <= 3 &&
> -		       nv_rd16i2cr(i2c, addr, 0xff) == 0x3220 &&
> +		return nv_rd16i2cr(i2c, addr, 0xff) == 0x3220 &&
>   		       nv_rd16i2cr(i2c, addr, 0xfe) == 0x5449;
>   	default:
>   		return false;
> @@ -67,8 +66,9 @@ nvkm_iccsense_ina2x9_read(struct nvkm_iccsense *iccsense,
>                             struct nvkm_iccsense_rail *rail,
>   			  u8 shunt_reg, u8 bus_reg)
>   {
> -	return nvkm_iccsense_poll_lane(rail->i2c, rail->addr, shunt_reg, 0,
> -				       bus_reg, 3, rail->mohm, 10 * 4);
> +	return nvkm_iccsense_poll_lane(rail->sensor->i2c, rail->sensor->addr,
> +				       shunt_reg, 0, bus_reg, 3, rail->mohm,
> +				       10 * 4);
>   }
>   
>   static int
> @@ -89,9 +89,9 @@ static int
>   nvkm_iccsense_ina3221_read(struct nvkm_iccsense *iccsense,
>   			   struct nvkm_iccsense_rail *rail)
>   {
> -	return nvkm_iccsense_poll_lane(rail->i2c, rail->addr,
> -				       1 + (rail->rail * 2), 3,
> -				       2 + (rail->rail * 2), 3, rail->mohm,
> +	return nvkm_iccsense_poll_lane(rail->sensor->i2c, rail->sensor->addr,
> +				       1 + (rail->idx * 2), 3,
> +				       2 + (rail->idx * 2), 3, rail->mohm,
>   				       40 * 8);
>   }
>   
> @@ -121,81 +121,137 @@ static void *
>   nvkm_iccsense_dtor(struct nvkm_subdev *subdev)
>   {
>   	struct nvkm_iccsense *iccsense = nvkm_iccsense(subdev);
> -	struct nvkm_iccsense_rail *rail, *tmp;
> +	struct nvkm_iccsense_sensor *sensor, *tmps;
> +	struct nvkm_iccsense_rail *rail, *tmpr;
>   
> -	list_for_each_entry_safe(rail, tmp, &iccsense->rails, head)
> +	list_for_each_entry_safe(sensor, tmps, &iccsense->sensors, head)
> +		kfree(sensor);
> +	list_for_each_entry_safe(rail, tmpr, &iccsense->rails, head)
>   		kfree(rail);

Same problem as the last patch.

>   
>   	return iccsense;
>   }
>   
> +static struct nvkm_iccsense_sensor*
> +nvkm_iccsense_create_sensor(struct nvkm_iccsense *iccsense, u8 id)
> +{
> +
> +	struct nvkm_subdev *subdev = &iccsense->subdev;
> +	struct nvkm_bios *bios = subdev->device->bios;
> +	struct nvkm_i2c *i2c = subdev->device->i2c;
> +	struct nvbios_extdev_func extdev;
> +	struct nvkm_i2c_bus *i2c_bus;
> +	struct nvkm_iccsense_sensor *sensor;
> +	u8 addr;
> +
> +	if (!i2c || !bios || nvbios_extdev_parse(bios, id, &extdev))
> +		return NULL;
> +
> +	if (extdev.type == 0xff)
> +		return NULL;
> +
> +	if (extdev.type != NVBIOS_EXTDEV_INA209 &&
> +	    extdev.type != NVBIOS_EXTDEV_INA219 &&
> +	    extdev.type != NVBIOS_EXTDEV_INA3221) {
> +		iccsense->data_valid = false;
> +		nvkm_error(subdev, "found unknown sensor type %x, "
> +			   "power reading might be invalid\n",
> +			   extdev.type);

You do not create the sensor if it is unknown, so why do you say the 
report might be invalid?

Please change it to "Unknown sensor type %x".

> +		return NULL;
> +	}
> +
> +	if (extdev.bus)
> +		i2c_bus = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_SEC);
> +	else
> +		i2c_bus = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_PRI);
> +	if (!i2c_bus)
> +		return NULL;
> +
> +	addr = extdev.addr >> 1;
> +	if (!nvkm_iccsense_validate_device(&i2c_bus->i2c, addr,
> +					   extdev.type)) {
> +		iccsense->data_valid = false;
> +		nvkm_warn(subdev, "found invalid sensor id: %i, power reading"
> +			  "might be invalid\n", id);
> +		return NULL;
> +	}
> +
> +	sensor = kmalloc(sizeof(*sensor), GFP_KERNEL);
> +	if (!sensor)
> +		return NULL;
> +
> +	list_add_tail(&sensor->head, &iccsense->sensors);
> +	sensor->id = id;
> +	sensor->type = extdev.type;
> +	sensor->i2c = &i2c_bus->i2c;
> +	sensor->addr = addr;
> +	sensor->rail_mask = 0x0;
> +	return sensor;
> +}
> +
> +static struct nvkm_iccsense_sensor*
> +nvkm_iccsense_get_sensor(struct nvkm_iccsense *iccsense, u8 id)
> +{
> +	struct nvkm_iccsense_sensor *sensor;
> +	list_for_each_entry(sensor, &iccsense->sensors, head) {
> +		if (sensor->id == id)
> +			return sensor;
> +	}
> +	return nvkm_iccsense_create_sensor(iccsense, id);
> +}
> +
>   static int
>   nvkm_iccsense_oneinit(struct nvkm_subdev *subdev)
>   {
>   	struct nvkm_iccsense *iccsense = nvkm_iccsense(subdev);
>   	struct nvkm_bios *bios = subdev->device->bios;
> -	struct nvkm_i2c *i2c = subdev->device->i2c;
>   	struct nvbios_iccsense stbl;
>   	int i;
>   
> -	if (!i2c || !bios || nvbios_iccsense_parse(bios, &stbl)
> -	    || !stbl.nr_entry)
> +	if (!bios || nvbios_iccsense_parse(bios, &stbl) || !stbl.nr_entry)
>   		return 0;
>   
>   	iccsense->data_valid = true;
>   	for (i = 0; i < stbl.nr_entry; ++i) {
>   		struct pwr_rail_t *r = &stbl.rail[i];
> -		struct nvbios_extdev_func extdev;
>   		struct nvkm_iccsense_rail *rail;
> -		struct nvkm_i2c_bus *i2c_bus;
> -		u8 addr;
> +		struct nvkm_iccsense_sensor *sensor;
>   
>   		if (!r->mode || r->resistor_mohm == 0)
>   			continue;
>   
> -		if (nvbios_extdev_parse(bios, r->extdev_id, &extdev))
> -			continue;
> -
> -		if (extdev.type == 0xff)
> -			continue;
> -
> -		if (extdev.bus)
> -			i2c_bus = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_SEC);
> -		else
> -			i2c_bus = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_PRI);
> -		if (!i2c_bus)
> +		sensor = nvkm_iccsense_get_sensor(iccsense, r->extdev_id);
> +		if (!sensor)
>   			continue;
>   
> -		addr = extdev.addr >> 1;
> -		if (!nvkm_iccsense_validate_device(&i2c_bus->i2c, addr,
> -						   extdev.type, r->rail)) {
> -			iccsense->data_valid = false;
> -			nvkm_warn(subdev, "found unknown or invalid rail entry"
> -				  " type 0x%x rail %i, power reading might be"
> -				  " invalid\n", extdev.type, r->rail);
> -			continue;
> -		}
> -
>   		rail = kmalloc(sizeof(*rail), GFP_KERNEL);
>   		if (!rail)
>   			return -ENOMEM;
>   
> -		switch (extdev.type) {
> +		switch (sensor->type) {
>   		case NVBIOS_EXTDEV_INA209:
> +			if (r->rail != 0)
> +				continue;
>   			rail->read = nvkm_iccsense_ina209_read;
>   			break;
>   		case NVBIOS_EXTDEV_INA219:
> +			if (r->rail != 0)
> +				continue;
>   			rail->read = nvkm_iccsense_ina219_read;
>   			break;
>   		case NVBIOS_EXTDEV_INA3221:
> +			if (r->rail >= 3)
> +				continue;
>   			rail->read = nvkm_iccsense_ina3221_read;
>   			break;
> +		default:
> +			continue;
>   		}
>   
> -		rail->addr = addr;
> -		rail->rail = r->rail;
> +		sensor->rail_mask |= 1 << r->rail;
> +		rail->sensor = sensor;
> +		rail->idx = r->rail;
>   		rail->mohm = r->resistor_mohm;
> -		rail->i2c = &i2c_bus->i2c;
>   		list_add_tail(&rail->head, &iccsense->rails);
>   	}
>   	return 0;
> @@ -219,6 +275,7 @@ nvkm_iccsense_new_(struct nvkm_device *device, int index,
>   {
>   	if (!(*iccsense = kzalloc(sizeof(**iccsense), GFP_KERNEL)))
>   		return -ENOMEM;
> +	INIT_LIST_HEAD(&(*iccsense)->sensors);
>   	INIT_LIST_HEAD(&(*iccsense)->rails);
>   	nvkm_iccsense_ctor(device, index, *iccsense);
>   	return 0;
> diff --git a/drm/nouveau/nvkm/subdev/iccsense/priv.h b/drm/nouveau/nvkm/subdev/iccsense/priv.h
> index e479128..b72c31d 100644
> --- a/drm/nouveau/nvkm/subdev/iccsense/priv.h
> +++ b/drm/nouveau/nvkm/subdev/iccsense/priv.h
> @@ -2,13 +2,22 @@
>   #define __NVKM_ICCSENSE_PRIV_H__
>   #define nvkm_iccsense(p) container_of((p), struct nvkm_iccsense, subdev)
>   #include <subdev/iccsense.h>
> +#include <subdev/bios/extdev.h>
>   
> -struct nvkm_iccsense_rail {
> +struct nvkm_iccsense_sensor {
>   	struct list_head head;
> -	int (*read)(struct nvkm_iccsense *, struct nvkm_iccsense_rail *);
> +	int id;
> +	enum nvbios_extdev_type type;
>   	struct i2c_adapter *i2c;
>   	u8 addr;
> -	u8 rail;
> +	u8 rail_mask;
> +};
> +
> +struct nvkm_iccsense_rail {
> +	struct list_head head;
> +	int (*read)(struct nvkm_iccsense *, struct nvkm_iccsense_rail *);
> +	struct nvkm_iccsense_sensor *sensor;
> +	u8 idx;
>   	u8 mohm;
>   };
>   

_______________________________________________
Nouveau mailing list
Nouveau@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/nouveau