[media] smiapp: Move sub-device initialisation into a separate function
Simplify smiapp_init() by moving the initialisation of individual sub-devices to a separate function. Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com> Reviewed-by: Sebastian Reichel <sre@kernel.org> Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>
This commit is contained in:
parent
669c6141ea
commit
b7547ef867
|
@ -2535,11 +2535,58 @@ static void smiapp_cleanup(struct smiapp_sensor *sensor)
|
|||
smiapp_free_controls(sensor);
|
||||
}
|
||||
|
||||
static void smiapp_create_subdev(struct smiapp_sensor *sensor,
|
||||
struct smiapp_subdev *ssd, const char *name)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(&sensor->src->sd);
|
||||
|
||||
if (!ssd)
|
||||
return;
|
||||
|
||||
if (ssd != sensor->src)
|
||||
v4l2_subdev_init(&ssd->sd, &smiapp_ops);
|
||||
|
||||
ssd->sensor = sensor;
|
||||
|
||||
if (ssd == sensor->pixel_array) {
|
||||
ssd->npads = 1;
|
||||
} else {
|
||||
ssd->npads = 2;
|
||||
ssd->source_pad = 1;
|
||||
}
|
||||
|
||||
snprintf(ssd->sd.name,
|
||||
sizeof(ssd->sd.name), "%s %s %d-%4.4x", sensor->minfo.name,
|
||||
name, i2c_adapter_id(client->adapter), client->addr);
|
||||
|
||||
ssd->sink_fmt.width =
|
||||
sensor->limits[SMIAPP_LIMIT_X_ADDR_MAX] + 1;
|
||||
ssd->sink_fmt.height =
|
||||
sensor->limits[SMIAPP_LIMIT_Y_ADDR_MAX] + 1;
|
||||
ssd->compose.width = ssd->sink_fmt.width;
|
||||
ssd->compose.height = ssd->sink_fmt.height;
|
||||
ssd->crop[ssd->source_pad] = ssd->compose;
|
||||
ssd->pads[ssd->source_pad].flags = MEDIA_PAD_FL_SOURCE;
|
||||
if (ssd != sensor->pixel_array) {
|
||||
ssd->crop[ssd->sink_pad] = ssd->compose;
|
||||
ssd->pads[ssd->sink_pad].flags = MEDIA_PAD_FL_SINK;
|
||||
}
|
||||
|
||||
ssd->sd.entity.ops = &smiapp_entity_ops;
|
||||
|
||||
if (ssd == sensor->src)
|
||||
return;
|
||||
|
||||
ssd->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
|
||||
ssd->sd.internal_ops = &smiapp_internal_ops;
|
||||
ssd->sd.owner = THIS_MODULE;
|
||||
v4l2_set_subdevdata(&ssd->sd, client);
|
||||
}
|
||||
|
||||
static int smiapp_init(struct smiapp_sensor *sensor)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(&sensor->src->sd);
|
||||
struct smiapp_pll *pll = &sensor->pll;
|
||||
struct smiapp_subdev *last = NULL;
|
||||
unsigned int i;
|
||||
int rval;
|
||||
|
||||
|
@ -2700,64 +2747,9 @@ static int smiapp_init(struct smiapp_sensor *sensor)
|
|||
if (sensor->minfo.smiapp_profile == SMIAPP_PROFILE_0)
|
||||
pll->flags |= SMIAPP_PLL_FLAG_NO_OP_CLOCKS;
|
||||
|
||||
for (i = 0; i < SMIAPP_SUBDEVS; i++) {
|
||||
struct {
|
||||
struct smiapp_subdev *ssd;
|
||||
char *name;
|
||||
} const __this[] = {
|
||||
{ sensor->scaler, "scaler", },
|
||||
{ sensor->binner, "binner", },
|
||||
{ sensor->pixel_array, "pixel array", },
|
||||
}, *_this = &__this[i];
|
||||
struct smiapp_subdev *this = _this->ssd;
|
||||
|
||||
if (!this)
|
||||
continue;
|
||||
|
||||
if (this != sensor->src)
|
||||
v4l2_subdev_init(&this->sd, &smiapp_ops);
|
||||
|
||||
this->sensor = sensor;
|
||||
|
||||
if (this == sensor->pixel_array) {
|
||||
this->npads = 1;
|
||||
} else {
|
||||
this->npads = 2;
|
||||
this->source_pad = 1;
|
||||
}
|
||||
|
||||
snprintf(this->sd.name,
|
||||
sizeof(this->sd.name), "%s %s %d-%4.4x",
|
||||
sensor->minfo.name, _this->name,
|
||||
i2c_adapter_id(client->adapter), client->addr);
|
||||
|
||||
this->sink_fmt.width =
|
||||
sensor->limits[SMIAPP_LIMIT_X_ADDR_MAX] + 1;
|
||||
this->sink_fmt.height =
|
||||
sensor->limits[SMIAPP_LIMIT_Y_ADDR_MAX] + 1;
|
||||
this->compose.width = this->sink_fmt.width;
|
||||
this->compose.height = this->sink_fmt.height;
|
||||
this->crop[this->source_pad] = this->compose;
|
||||
this->pads[this->source_pad].flags = MEDIA_PAD_FL_SOURCE;
|
||||
if (this != sensor->pixel_array) {
|
||||
this->crop[this->sink_pad] = this->compose;
|
||||
this->pads[this->sink_pad].flags = MEDIA_PAD_FL_SINK;
|
||||
}
|
||||
|
||||
this->sd.entity.ops = &smiapp_entity_ops;
|
||||
|
||||
if (last == NULL) {
|
||||
last = this;
|
||||
continue;
|
||||
}
|
||||
|
||||
this->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
|
||||
this->sd.internal_ops = &smiapp_internal_ops;
|
||||
this->sd.owner = THIS_MODULE;
|
||||
v4l2_set_subdevdata(&this->sd, client);
|
||||
|
||||
last = this;
|
||||
}
|
||||
smiapp_create_subdev(sensor, sensor->scaler, "scaler");
|
||||
smiapp_create_subdev(sensor, sensor->binner, "binner");
|
||||
smiapp_create_subdev(sensor, sensor->pixel_array, "pixel_array");
|
||||
|
||||
dev_dbg(&client->dev, "profile %d\n", sensor->minfo.smiapp_profile);
|
||||
|
||||
|
|
Loading…
Reference in New Issue