mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-25 00:51:28 +07:00
iio: dummy: Demonstrate the usage of new channel types
Adds support for the new channel types in the dummy driver: * a new channel IIO_ACTIVITY * two state transition events (running and walking) * a new channel IIO_STEPS and support for reading and writing pedometer step counter * step detect event * a new IIO_CHAN_INFO_CALIBHEIGHT mask bit for reading and writing user's height. Signed-off-by: Irina Tirdea <irina.tirdea@intel.com> Signed-off-by: Daniel Baluta <daniel.baluta@intel.com> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
parent
bcdf28fb1b
commit
3e34e650db
@ -69,6 +69,34 @@ static const struct iio_event_spec iio_dummy_event = {
|
||||
.mask_separate = BIT(IIO_EV_INFO_VALUE) | BIT(IIO_EV_INFO_ENABLE),
|
||||
};
|
||||
|
||||
/*
|
||||
* simple step detect event - triggered when a step is detected
|
||||
*/
|
||||
static const struct iio_event_spec step_detect_event = {
|
||||
.type = IIO_EV_TYPE_INSTANCE,
|
||||
.dir = IIO_EV_DIR_NONE,
|
||||
.mask_separate = BIT(IIO_EV_INFO_ENABLE),
|
||||
};
|
||||
|
||||
/*
|
||||
* simple transition event - triggered when the reported running confidence
|
||||
* value rises above a threshold value
|
||||
*/
|
||||
static const struct iio_event_spec iio_running_event = {
|
||||
.type = IIO_EV_TYPE_THRESH,
|
||||
.dir = IIO_EV_DIR_RISING,
|
||||
.mask_separate = BIT(IIO_EV_INFO_VALUE) | BIT(IIO_EV_INFO_ENABLE),
|
||||
};
|
||||
|
||||
/*
|
||||
* simple transition event - triggered when the reported walking confidence
|
||||
* value falls under a threshold value
|
||||
*/
|
||||
static const struct iio_event_spec iio_walking_event = {
|
||||
.type = IIO_EV_TYPE_THRESH,
|
||||
.dir = IIO_EV_DIR_FALLING,
|
||||
.mask_separate = BIT(IIO_EV_INFO_VALUE) | BIT(IIO_EV_INFO_ENABLE),
|
||||
};
|
||||
#endif
|
||||
|
||||
/*
|
||||
@ -215,6 +243,37 @@ static const struct iio_chan_spec iio_dummy_channels[] = {
|
||||
.indexed = 1,
|
||||
.channel = 0,
|
||||
},
|
||||
{
|
||||
.type = IIO_STEPS,
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_ENABLE) |
|
||||
BIT(IIO_CHAN_INFO_CALIBHEIGHT),
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.scan_index = -1,
|
||||
#ifdef CONFIG_IIO_SIMPLE_DUMMY_EVENTS
|
||||
.event_spec = &step_detect_event,
|
||||
.num_event_specs = 1,
|
||||
#endif /* CONFIG_IIO_SIMPLE_DUMMY_EVENTS */
|
||||
},
|
||||
{
|
||||
.type = IIO_ACTIVITY,
|
||||
.modified = 1,
|
||||
.channel2 = IIO_MOD_RUNNING,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
#ifdef CONFIG_IIO_SIMPLE_DUMMY_EVENTS
|
||||
.event_spec = &iio_running_event,
|
||||
.num_event_specs = 1,
|
||||
#endif /* CONFIG_IIO_SIMPLE_DUMMY_EVENTS */
|
||||
},
|
||||
{
|
||||
.type = IIO_ACTIVITY,
|
||||
.modified = 1,
|
||||
.channel2 = IIO_MOD_WALKING,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
#ifdef CONFIG_IIO_SIMPLE_DUMMY_EVENTS
|
||||
.event_spec = &iio_walking_event,
|
||||
.num_event_specs = 1,
|
||||
#endif /* CONFIG_IIO_SIMPLE_DUMMY_EVENTS */
|
||||
},
|
||||
};
|
||||
|
||||
/**
|
||||
@ -263,12 +322,38 @@ static int iio_dummy_read_raw(struct iio_dev *indio_dev,
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_PROCESSED:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
*val = st->steps;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
case IIO_ACTIVITY:
|
||||
switch (chan->channel2) {
|
||||
case IIO_MOD_RUNNING:
|
||||
*val = st->activity_running;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
case IIO_MOD_WALKING:
|
||||
*val = st->activity_walking;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_OFFSET:
|
||||
/* only single ended adc -> 7 */
|
||||
*val = 7;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
switch (chan->type) {
|
||||
case IIO_VOLTAGE:
|
||||
switch (chan->differential) {
|
||||
case 0:
|
||||
/* only single ended adc -> 0.001333 */
|
||||
@ -277,12 +362,17 @@ static int iio_dummy_read_raw(struct iio_dev *indio_dev,
|
||||
ret = IIO_VAL_INT_PLUS_MICRO;
|
||||
break;
|
||||
case 1:
|
||||
/* all differential adc channels -> 0.000001344 */
|
||||
/* all differential adc channels ->
|
||||
* 0.000001344 */
|
||||
*val = 0;
|
||||
*val2 = 1344;
|
||||
ret = IIO_VAL_INT_PLUS_NANO;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_CALIBBIAS:
|
||||
/* only the acceleration axis - read from cache */
|
||||
*val = st->accel_calibbias;
|
||||
@ -298,6 +388,27 @@ static int iio_dummy_read_raw(struct iio_dev *indio_dev,
|
||||
*val2 = 33;
|
||||
ret = IIO_VAL_INT_PLUS_NANO;
|
||||
break;
|
||||
case IIO_CHAN_INFO_ENABLE:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
*val = st->steps_enabled;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_CALIBHEIGHT:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
*val = st->height;
|
||||
ret = IIO_VAL_INT;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
@ -330,6 +441,8 @@ static int iio_dummy_write_raw(struct iio_dev *indio_dev,
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
switch (chan->type) {
|
||||
case IIO_VOLTAGE:
|
||||
if (chan->output == 0)
|
||||
return -EINVAL;
|
||||
|
||||
@ -338,6 +451,35 @@ static int iio_dummy_write_raw(struct iio_dev *indio_dev,
|
||||
st->dac_val = val;
|
||||
mutex_unlock(&st->lock);
|
||||
return 0;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_PROCESSED:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
mutex_lock(&st->lock);
|
||||
st->steps = val;
|
||||
mutex_unlock(&st->lock);
|
||||
return 0;
|
||||
case IIO_ACTIVITY:
|
||||
if (val < 0)
|
||||
val = 0;
|
||||
if (val > 100)
|
||||
val = 100;
|
||||
switch (chan->channel2) {
|
||||
case IIO_MOD_RUNNING:
|
||||
st->activity_running = val;
|
||||
return 0;
|
||||
case IIO_MOD_WALKING:
|
||||
st->activity_walking = val;
|
||||
return 0;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_CALIBSCALE:
|
||||
mutex_lock(&st->lock);
|
||||
/* Compare against table - hard matching here */
|
||||
@ -356,6 +498,24 @@ static int iio_dummy_write_raw(struct iio_dev *indio_dev,
|
||||
st->accel_calibbias = val;
|
||||
mutex_unlock(&st->lock);
|
||||
return 0;
|
||||
case IIO_CHAN_INFO_ENABLE:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
mutex_lock(&st->lock);
|
||||
st->steps_enabled = val;
|
||||
mutex_unlock(&st->lock);
|
||||
return 0;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_CALIBHEIGHT:
|
||||
switch (chan->type) {
|
||||
case IIO_STEPS:
|
||||
st->height = val;
|
||||
return 0;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
@ -395,6 +555,9 @@ static int iio_dummy_init_device(struct iio_dev *indio_dev)
|
||||
st->accel_val = 34;
|
||||
st->accel_calibbias = -7;
|
||||
st->accel_calibscale = &dummy_scales[0];
|
||||
st->steps = 47;
|
||||
st->activity_running = 98;
|
||||
st->activity_walking = 4;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
@ -34,9 +34,14 @@ struct iio_dummy_state {
|
||||
int differential_adc_val[2];
|
||||
int accel_val;
|
||||
int accel_calibbias;
|
||||
int activity_running;
|
||||
int activity_walking;
|
||||
const struct iio_dummy_accel_calibscale *accel_calibscale;
|
||||
struct mutex lock;
|
||||
struct iio_dummy_regs *regs;
|
||||
int steps_enabled;
|
||||
int steps;
|
||||
int height;
|
||||
#ifdef CONFIG_IIO_SIMPLE_DUMMY_EVENTS
|
||||
int event_irq;
|
||||
int event_val;
|
||||
|
@ -72,6 +72,22 @@ int iio_simple_dummy_write_event_config(struct iio_dev *indio_dev,
|
||||
st->event_en = state;
|
||||
else
|
||||
return -EINVAL;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case IIO_ACTIVITY:
|
||||
switch (type) {
|
||||
case IIO_EV_TYPE_THRESH:
|
||||
st->event_en = state;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_STEPS:
|
||||
switch (type) {
|
||||
case IIO_EV_TYPE_INSTANCE:
|
||||
st->event_en = state;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
@ -161,6 +177,33 @@ static irqreturn_t iio_simple_dummy_event_handler(int irq, void *private)
|
||||
IIO_EV_TYPE_THRESH, 0, 0, 0),
|
||||
iio_get_time_ns());
|
||||
break;
|
||||
case 1:
|
||||
if (st->activity_running > st->event_val)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_EVENT_CODE(IIO_ACTIVITY, 0,
|
||||
IIO_MOD_RUNNING,
|
||||
IIO_EV_DIR_RISING,
|
||||
IIO_EV_TYPE_THRESH,
|
||||
0, 0, 0),
|
||||
iio_get_time_ns());
|
||||
break;
|
||||
case 2:
|
||||
if (st->activity_walking < st->event_val)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_EVENT_CODE(IIO_ACTIVITY, 0,
|
||||
IIO_MOD_WALKING,
|
||||
IIO_EV_DIR_FALLING,
|
||||
IIO_EV_TYPE_THRESH,
|
||||
0, 0, 0),
|
||||
iio_get_time_ns());
|
||||
break;
|
||||
case 3:
|
||||
iio_push_event(indio_dev,
|
||||
IIO_EVENT_CODE(IIO_STEPS, 0, IIO_NO_MOD,
|
||||
IIO_EV_DIR_NONE,
|
||||
IIO_EV_TYPE_INSTANCE, 0, 0, 0),
|
||||
iio_get_time_ns());
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user