Commit d49e6ee2 authored by William Breathitt Gray's avatar William Breathitt Gray Committed by Jonathan Cameron

counter: Simplify the count_read and count_write callbacks

The count_read and count_write callbacks are simplified to pass val as
unsigned long rather than as an opaque data structure. The opaque
counter_count_read_value and counter_count_write_value structures,
counter_count_value_type enum, and relevant counter_count_read_value_set
and counter_count_write_value_get functions, are removed as they are no
longer used.

Cc: Patrick Havelange <patrick.havelange@essensium.com>
Acked-by: default avatarFabrice Gasnier <fabrice.gasnier@st.com>
Acked-by: default avatarDavid Lechner <david@lechnology.com>
Signed-off-by: default avatarWilliam Breathitt Gray <vilhelm.gray@gmail.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 16922ffe
...@@ -562,11 +562,10 @@ static const struct iio_chan_spec quad8_channels[] = { ...@@ -562,11 +562,10 @@ static const struct iio_chan_spec quad8_channels[] = {
}; };
static int quad8_signal_read(struct counter_device *counter, static int quad8_signal_read(struct counter_device *counter,
struct counter_signal *signal, struct counter_signal_read_value *val) struct counter_signal *signal, enum counter_signal_value *val)
{ {
const struct quad8_iio *const priv = counter->priv; const struct quad8_iio *const priv = counter->priv;
unsigned int state; unsigned int state;
enum counter_signal_level level;
/* Only Index signal levels can be read */ /* Only Index signal levels can be read */
if (signal->id < 16) if (signal->id < 16)
...@@ -575,22 +574,19 @@ static int quad8_signal_read(struct counter_device *counter, ...@@ -575,22 +574,19 @@ static int quad8_signal_read(struct counter_device *counter,
state = inb(priv->base + QUAD8_REG_INDEX_INPUT_LEVELS) state = inb(priv->base + QUAD8_REG_INDEX_INPUT_LEVELS)
& BIT(signal->id - 16); & BIT(signal->id - 16);
level = (state) ? COUNTER_SIGNAL_LEVEL_HIGH : COUNTER_SIGNAL_LEVEL_LOW; *val = (state) ? COUNTER_SIGNAL_HIGH : COUNTER_SIGNAL_LOW;
counter_signal_read_value_set(val, COUNTER_SIGNAL_LEVEL, &level);
return 0; return 0;
} }
static int quad8_count_read(struct counter_device *counter, static int quad8_count_read(struct counter_device *counter,
struct counter_count *count, struct counter_count_read_value *val) struct counter_count *count, unsigned long *val)
{ {
const struct quad8_iio *const priv = counter->priv; const struct quad8_iio *const priv = counter->priv;
const int base_offset = priv->base + 2 * count->id; const int base_offset = priv->base + 2 * count->id;
unsigned int flags; unsigned int flags;
unsigned int borrow; unsigned int borrow;
unsigned int carry; unsigned int carry;
unsigned long position;
int i; int i;
flags = inb(base_offset + 1); flags = inb(base_offset + 1);
...@@ -598,36 +594,27 @@ static int quad8_count_read(struct counter_device *counter, ...@@ -598,36 +594,27 @@ static int quad8_count_read(struct counter_device *counter,
carry = !!(flags & QUAD8_FLAG_CT); carry = !!(flags & QUAD8_FLAG_CT);
/* Borrow XOR Carry effectively doubles count range */ /* Borrow XOR Carry effectively doubles count range */
position = (unsigned long)(borrow ^ carry) << 24; *val = (unsigned long)(borrow ^ carry) << 24;
/* Reset Byte Pointer; transfer Counter to Output Latch */ /* Reset Byte Pointer; transfer Counter to Output Latch */
outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_BP | QUAD8_RLD_CNTR_OUT, outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_BP | QUAD8_RLD_CNTR_OUT,
base_offset + 1); base_offset + 1);
for (i = 0; i < 3; i++) for (i = 0; i < 3; i++)
position |= (unsigned long)inb(base_offset) << (8 * i); *val |= (unsigned long)inb(base_offset) << (8 * i);
counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &position);
return 0; return 0;
} }
static int quad8_count_write(struct counter_device *counter, static int quad8_count_write(struct counter_device *counter,
struct counter_count *count, struct counter_count_write_value *val) struct counter_count *count, unsigned long val)
{ {
const struct quad8_iio *const priv = counter->priv; const struct quad8_iio *const priv = counter->priv;
const int base_offset = priv->base + 2 * count->id; const int base_offset = priv->base + 2 * count->id;
int err;
unsigned long position;
int i; int i;
err = counter_count_write_value_get(&position, COUNTER_COUNT_POSITION,
val);
if (err)
return err;
/* Only 24-bit values are supported */ /* Only 24-bit values are supported */
if (position > 0xFFFFFF) if (val > 0xFFFFFF)
return -EINVAL; return -EINVAL;
/* Reset Byte Pointer */ /* Reset Byte Pointer */
...@@ -635,7 +622,7 @@ static int quad8_count_write(struct counter_device *counter, ...@@ -635,7 +622,7 @@ static int quad8_count_write(struct counter_device *counter,
/* Counter can only be set via Preset Register */ /* Counter can only be set via Preset Register */
for (i = 0; i < 3; i++) for (i = 0; i < 3; i++)
outb(position >> (8 * i), base_offset); outb(val >> (8 * i), base_offset);
/* Transfer Preset Register to Counter */ /* Transfer Preset Register to Counter */
outb(QUAD8_CTR_RLD | QUAD8_RLD_PRESET_CNTR, base_offset + 1); outb(QUAD8_CTR_RLD | QUAD8_RLD_PRESET_CNTR, base_offset + 1);
...@@ -644,9 +631,9 @@ static int quad8_count_write(struct counter_device *counter, ...@@ -644,9 +631,9 @@ static int quad8_count_write(struct counter_device *counter,
outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_BP, base_offset + 1); outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_BP, base_offset + 1);
/* Set Preset Register back to original value */ /* Set Preset Register back to original value */
position = priv->preset[count->id]; val = priv->preset[count->id];
for (i = 0; i < 3; i++) for (i = 0; i < 3; i++)
outb(position >> (8 * i), base_offset); outb(val >> (8 * i), base_offset);
/* Reset Borrow, Carry, Compare, and Sign flags */ /* Reset Borrow, Carry, Compare, and Sign flags */
outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_FLAGS, base_offset + 1); outb(QUAD8_CTR_RLD | QUAD8_RLD_RESET_FLAGS, base_offset + 1);
......
...@@ -220,86 +220,6 @@ ssize_t counter_device_enum_available_read(struct counter_device *counter, ...@@ -220,86 +220,6 @@ ssize_t counter_device_enum_available_read(struct counter_device *counter,
} }
EXPORT_SYMBOL_GPL(counter_device_enum_available_read); EXPORT_SYMBOL_GPL(counter_device_enum_available_read);
static const char *const counter_signal_level_str[] = {
[COUNTER_SIGNAL_LEVEL_LOW] = "low",
[COUNTER_SIGNAL_LEVEL_HIGH] = "high"
};
/**
* counter_signal_read_value_set - set counter_signal_read_value data
* @val: counter_signal_read_value structure to set
* @type: property Signal data represents
* @data: Signal data
*
* This function sets an opaque counter_signal_read_value structure with the
* provided Signal data.
*/
void counter_signal_read_value_set(struct counter_signal_read_value *const val,
const enum counter_signal_value_type type,
void *const data)
{
if (type == COUNTER_SIGNAL_LEVEL)
val->len = sprintf(val->buf, "%s\n",
counter_signal_level_str[*(enum counter_signal_level *)data]);
else
val->len = 0;
}
EXPORT_SYMBOL_GPL(counter_signal_read_value_set);
/**
* counter_count_read_value_set - set counter_count_read_value data
* @val: counter_count_read_value structure to set
* @type: property Count data represents
* @data: Count data
*
* This function sets an opaque counter_count_read_value structure with the
* provided Count data.
*/
void counter_count_read_value_set(struct counter_count_read_value *const val,
const enum counter_count_value_type type,
void *const data)
{
switch (type) {
case COUNTER_COUNT_POSITION:
val->len = sprintf(val->buf, "%lu\n", *(unsigned long *)data);
break;
default:
val->len = 0;
}
}
EXPORT_SYMBOL_GPL(counter_count_read_value_set);
/**
* counter_count_write_value_get - get counter_count_write_value data
* @data: Count data
* @type: property Count data represents
* @val: counter_count_write_value structure containing data
*
* This function extracts Count data from the provided opaque
* counter_count_write_value structure and stores it at the address provided by
* @data.
*
* RETURNS:
* 0 on success, negative error number on failure.
*/
int counter_count_write_value_get(void *const data,
const enum counter_count_value_type type,
const struct counter_count_write_value *const val)
{
int err;
switch (type) {
case COUNTER_COUNT_POSITION:
err = kstrtoul(val->buf, 0, data);
if (err)
return err;
break;
}
return 0;
}
EXPORT_SYMBOL_GPL(counter_count_write_value_get);
struct counter_attr_parm { struct counter_attr_parm {
struct counter_device_attr_group *group; struct counter_device_attr_group *group;
const char *prefix; const char *prefix;
...@@ -369,6 +289,11 @@ struct counter_signal_unit { ...@@ -369,6 +289,11 @@ struct counter_signal_unit {
struct counter_signal *signal; struct counter_signal *signal;
}; };
static const char *const counter_signal_value_str[] = {
[COUNTER_SIGNAL_LOW] = "low",
[COUNTER_SIGNAL_HIGH] = "high"
};
static ssize_t counter_signal_show(struct device *dev, static ssize_t counter_signal_show(struct device *dev,
struct device_attribute *attr, char *buf) struct device_attribute *attr, char *buf)
{ {
...@@ -377,13 +302,13 @@ static ssize_t counter_signal_show(struct device *dev, ...@@ -377,13 +302,13 @@ static ssize_t counter_signal_show(struct device *dev,
const struct counter_signal_unit *const component = devattr->component; const struct counter_signal_unit *const component = devattr->component;
struct counter_signal *const signal = component->signal; struct counter_signal *const signal = component->signal;
int err; int err;
struct counter_signal_read_value val = { .buf = buf }; enum counter_signal_value val;
err = counter->ops->signal_read(counter, signal, &val); err = counter->ops->signal_read(counter, signal, &val);
if (err) if (err)
return err; return err;
return val.len; return sprintf(buf, "%s\n", counter_signal_value_str[val]);
} }
struct counter_name_unit { struct counter_name_unit {
...@@ -788,13 +713,13 @@ static ssize_t counter_count_show(struct device *dev, ...@@ -788,13 +713,13 @@ static ssize_t counter_count_show(struct device *dev,
const struct counter_count_unit *const component = devattr->component; const struct counter_count_unit *const component = devattr->component;
struct counter_count *const count = component->count; struct counter_count *const count = component->count;
int err; int err;
struct counter_count_read_value val = { .buf = buf }; unsigned long val;
err = counter->ops->count_read(counter, count, &val); err = counter->ops->count_read(counter, count, &val);
if (err) if (err)
return err; return err;
return val.len; return sprintf(buf, "%lu\n", val);
} }
static ssize_t counter_count_store(struct device *dev, static ssize_t counter_count_store(struct device *dev,
...@@ -806,9 +731,13 @@ static ssize_t counter_count_store(struct device *dev, ...@@ -806,9 +731,13 @@ static ssize_t counter_count_store(struct device *dev,
const struct counter_count_unit *const component = devattr->component; const struct counter_count_unit *const component = devattr->component;
struct counter_count *const count = component->count; struct counter_count *const count = component->count;
int err; int err;
struct counter_count_write_value val = { .buf = buf }; unsigned long val;
err = kstrtoul(buf, 0, &val);
if (err)
return err;
err = counter->ops->count_write(counter, count, &val); err = counter->ops->count_write(counter, count, val);
if (err) if (err)
return err; return err;
......
...@@ -178,31 +178,25 @@ static const enum counter_count_function ftm_quaddec_count_functions[] = { ...@@ -178,31 +178,25 @@ static const enum counter_count_function ftm_quaddec_count_functions[] = {
static int ftm_quaddec_count_read(struct counter_device *counter, static int ftm_quaddec_count_read(struct counter_device *counter,
struct counter_count *count, struct counter_count *count,
struct counter_count_read_value *val) unsigned long *val)
{ {
struct ftm_quaddec *const ftm = counter->priv; struct ftm_quaddec *const ftm = counter->priv;
uint32_t cntval; uint32_t cntval;
ftm_read(ftm, FTM_CNT, &cntval); ftm_read(ftm, FTM_CNT, &cntval);
counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cntval); *val = cntval;
return 0; return 0;
} }
static int ftm_quaddec_count_write(struct counter_device *counter, static int ftm_quaddec_count_write(struct counter_device *counter,
struct counter_count *count, struct counter_count *count,
struct counter_count_write_value *val) const unsigned long val)
{ {
struct ftm_quaddec *const ftm = counter->priv; struct ftm_quaddec *const ftm = counter->priv;
u32 cnt;
int err;
err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val); if (val != 0) {
if (err)
return err;
if (cnt != 0) {
dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n"); dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n");
return -EINVAL; return -EINVAL;
} }
......
...@@ -377,8 +377,7 @@ static enum counter_synapse_action stm32_lptim_cnt_synapse_actions[] = { ...@@ -377,8 +377,7 @@ static enum counter_synapse_action stm32_lptim_cnt_synapse_actions[] = {
}; };
static int stm32_lptim_cnt_read(struct counter_device *counter, static int stm32_lptim_cnt_read(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long *val)
struct counter_count_read_value *val)
{ {
struct stm32_lptim_cnt *const priv = counter->priv; struct stm32_lptim_cnt *const priv = counter->priv;
u32 cnt; u32 cnt;
...@@ -388,7 +387,7 @@ static int stm32_lptim_cnt_read(struct counter_device *counter, ...@@ -388,7 +387,7 @@ static int stm32_lptim_cnt_read(struct counter_device *counter,
if (ret) if (ret)
return ret; return ret;
counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cnt); *val = cnt;
return 0; return 0;
} }
......
...@@ -48,34 +48,27 @@ static enum counter_count_function stm32_count_functions[] = { ...@@ -48,34 +48,27 @@ static enum counter_count_function stm32_count_functions[] = {
}; };
static int stm32_count_read(struct counter_device *counter, static int stm32_count_read(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long *val)
struct counter_count_read_value *val)
{ {
struct stm32_timer_cnt *const priv = counter->priv; struct stm32_timer_cnt *const priv = counter->priv;
u32 cnt; u32 cnt;
regmap_read(priv->regmap, TIM_CNT, &cnt); regmap_read(priv->regmap, TIM_CNT, &cnt);
counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cnt); *val = cnt;
return 0; return 0;
} }
static int stm32_count_write(struct counter_device *counter, static int stm32_count_write(struct counter_device *counter,
struct counter_count *count, struct counter_count *count,
struct counter_count_write_value *val) const unsigned long val)
{ {
struct stm32_timer_cnt *const priv = counter->priv; struct stm32_timer_cnt *const priv = counter->priv;
u32 cnt;
int err;
err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val);
if (err)
return err;
if (cnt > priv->ceiling) if (val > priv->ceiling)
return -EINVAL; return -EINVAL;
return regmap_write(priv->regmap, TIM_CNT, cnt); return regmap_write(priv->regmap, TIM_CNT, val);
} }
static int stm32_count_function_get(struct counter_device *counter, static int stm32_count_function_get(struct counter_device *counter,
......
...@@ -93,35 +93,28 @@ struct ti_eqep_cnt { ...@@ -93,35 +93,28 @@ struct ti_eqep_cnt {
}; };
static int ti_eqep_count_read(struct counter_device *counter, static int ti_eqep_count_read(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long *val)
struct counter_count_read_value *val)
{ {
struct ti_eqep_cnt *priv = counter->priv; struct ti_eqep_cnt *priv = counter->priv;
u32 cnt; u32 cnt;
regmap_read(priv->regmap32, QPOSCNT, &cnt); regmap_read(priv->regmap32, QPOSCNT, &cnt);
counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cnt); *val = cnt;
return 0; return 0;
} }
static int ti_eqep_count_write(struct counter_device *counter, static int ti_eqep_count_write(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long val)
struct counter_count_write_value *val)
{ {
struct ti_eqep_cnt *priv = counter->priv; struct ti_eqep_cnt *priv = counter->priv;
u32 cnt, max; u32 max;
int err;
err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val);
if (err)
return err;
regmap_read(priv->regmap32, QPOSMAX, &max); regmap_read(priv->regmap32, QPOSMAX, &max);
if (cnt > max) if (val > max)
return -EINVAL; return -EINVAL;
return regmap_write(priv->regmap32, QPOSCNT, cnt); return regmap_write(priv->regmap32, QPOSCNT, val);
} }
static int ti_eqep_function_get(struct counter_device *counter, static int ti_eqep_function_get(struct counter_device *counter,
......
...@@ -290,53 +290,22 @@ struct counter_device_state { ...@@ -290,53 +290,22 @@ struct counter_device_state {
const struct attribute_group **groups; const struct attribute_group **groups;
}; };
/** enum counter_signal_value {
* struct counter_signal_read_value - Opaque Signal read value COUNTER_SIGNAL_LOW = 0,
* @buf: string representation of Signal read value COUNTER_SIGNAL_HIGH
* @len: length of string in @buf
*/
struct counter_signal_read_value {
char *buf;
size_t len;
};
/**
* struct counter_count_read_value - Opaque Count read value
* @buf: string representation of Count read value
* @len: length of string in @buf
*/
struct counter_count_read_value {
char *buf;
size_t len;
};
/**
* struct counter_count_write_value - Opaque Count write value
* @buf: string representation of Count write value
*/
struct counter_count_write_value {
const char *buf;
}; };
/** /**
* struct counter_ops - Callbacks from driver * struct counter_ops - Callbacks from driver
* @signal_read: optional read callback for Signal attribute. The read * @signal_read: optional read callback for Signal attribute. The read
* value of the respective Signal should be passed back via * value of the respective Signal should be passed back via
* the val parameter. val points to an opaque type which * the val parameter.
* should be set only by calling the
* counter_signal_read_value_set function from within the
* signal_read callback.
* @count_read: optional read callback for Count attribute. The read * @count_read: optional read callback for Count attribute. The read
* value of the respective Count should be passed back via * value of the respective Count should be passed back via
* the val parameter. val points to an opaque type which * the val parameter.
* should be set only by calling the
* counter_count_read_value_set function from within the
* count_read callback.
* @count_write: optional write callback for Count attribute. The write * @count_write: optional write callback for Count attribute. The write
* value for the respective Count is passed in via the val * value for the respective Count is passed in via the val
* parameter. val points to an opaque type which should be * parameter.
* accessed only by calling the
* counter_count_write_value_get function.
* @function_get: function to get the current count function mode. Returns * @function_get: function to get the current count function mode. Returns
* 0 on success and negative error code on error. The index * 0 on success and negative error code on error. The index
* of the respective Count's returned function mode should * of the respective Count's returned function mode should
...@@ -355,13 +324,11 @@ struct counter_count_write_value { ...@@ -355,13 +324,11 @@ struct counter_count_write_value {
struct counter_ops { struct counter_ops {
int (*signal_read)(struct counter_device *counter, int (*signal_read)(struct counter_device *counter,
struct counter_signal *signal, struct counter_signal *signal,
struct counter_signal_read_value *val); enum counter_signal_value *val);
int (*count_read)(struct counter_device *counter, int (*count_read)(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long *val);
struct counter_count_read_value *val);
int (*count_write)(struct counter_device *counter, int (*count_write)(struct counter_device *counter,
struct counter_count *count, struct counter_count *count, unsigned long val);
struct counter_count_write_value *val);
int (*function_get)(struct counter_device *counter, int (*function_get)(struct counter_device *counter,
struct counter_count *count, size_t *function); struct counter_count *count, size_t *function);
int (*function_set)(struct counter_device *counter, int (*function_set)(struct counter_device *counter,
...@@ -477,29 +444,6 @@ struct counter_device { ...@@ -477,29 +444,6 @@ struct counter_device {
void *priv; void *priv;
}; };
enum counter_signal_level {
COUNTER_SIGNAL_LEVEL_LOW = 0,
COUNTER_SIGNAL_LEVEL_HIGH
};
enum counter_signal_value_type {
COUNTER_SIGNAL_LEVEL = 0
};
enum counter_count_value_type {
COUNTER_COUNT_POSITION = 0,
};
void counter_signal_read_value_set(struct counter_signal_read_value *const val,
const enum counter_signal_value_type type,
void *const data);
void counter_count_read_value_set(struct counter_count_read_value *const val,
const enum counter_count_value_type type,
void *const data);
int counter_count_write_value_get(void *const data,
const enum counter_count_value_type type,
const struct counter_count_write_value *const val);
int counter_register(struct counter_device *const counter); int counter_register(struct counter_device *const counter);
void counter_unregister(struct counter_device *const counter); void counter_unregister(struct counter_device *const counter);
int devm_counter_register(struct device *dev, int devm_counter_register(struct device *dev,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment