void mxr_streamer_get(struct mxr_device *mdev)
{
mutex_lock(&mdev->mutex);
++mdev->n_streamer;
mxr_dbg(mdev, "%s(%d)\n", __func__, mdev->n_streamer);
if (mdev->n_streamer == 1) {
struct v4l2_subdev *sd = to_outsd(mdev);
struct v4l2_mbus_framefmt mbus_fmt;
struct mxr_resources *res = &mdev->res;
int ret;
if (to_output(mdev)->cookie == 0)
clk_set_parent(res->sclk_mixer, res->sclk_dac);
else
clk_set_parent(res->sclk_mixer, res->sclk_hdmi);
mxr_reg_s_output(mdev, to_output(mdev)->cookie);
ret = v4l2_subdev_call(sd, video, g_mbus_fmt, &mbus_fmt);
WARN(ret, "failed to get mbus_fmt for output %s\n", sd->name);
ret = v4l2_subdev_call(sd, video, s_stream, 1);
WARN(ret, "starting stream failed for output %s\n", sd->name);
mxr_reg_set_mbus_fmt(mdev, &mbus_fmt);
mxr_reg_streamon(mdev);
ret = mxr_reg_wait4vsync(mdev);
WARN(ret, "failed to get vsync (%d) from output\n", ret);
}
mutex_unlock(&mdev->mutex);
mxr_reg_dump(mdev);
/* FIXME: what to do when streaming fails? */
}
void mxr_streamer_put(struct mxr_device *mdev)
{
mutex_lock(&mdev->mutex);
--mdev->n_streamer;
mxr_dbg(mdev, "%s(%d)\n", __func__, mdev->n_streamer);
if (mdev->n_streamer == 0) {
int ret;
struct v4l2_subdev *sd = to_outsd(mdev);
mxr_reg_streamoff(mdev);
/* vsync applies Mixer setup */
ret = mxr_reg_wait4vsync(mdev);
WARN(ret, "failed to get vsync (%d) from output\n", ret);
ret = v4l2_subdev_call(sd, video, s_stream, 0);
WARN(ret, "stopping stream failed for output %s\n", sd->name);
}
WARN(mdev->n_streamer < 0, "negative number of streamers (%d)\n",
mdev->n_streamer);
mutex_unlock(&mdev->mutex);
mxr_reg_dump(mdev);
}
static int mxr_streamer_get(struct mxr_device *mdev, struct v4l2_subdev* sd)
{
int i, ret;
int local = 1;
struct sub_mxr_device *sub_mxr;
struct mxr_layer *layer;
struct media_pad *pad;
struct v4l2_mbus_framefmt mbus_fmt;
#if defined(CONFIG_CPU_EXYNOS4210)
struct mxr_resources *res = &mdev->res;
#endif
mutex_lock(&mdev->s_mutex);
++mdev->n_streamer;
mxr_dbg(mdev, "%s(%d)\n", __func__, mdev->n_streamer);
/* If pipeline is started from Gscaler input video device,
* TV basic configuration must be set before running mixer */
if (mdev->mxr_data_from == FROM_GSC_SD) {
mxr_dbg(mdev, "%s: from gscaler\n", __func__);
local = 0;
/* enable mixer clock */
ret = mxr_power_get(mdev);
if (ret) {
mxr_err(mdev, "power on failed\n");
return -ENODEV;
}
/* turn on connected output device through link
* with mixer */
mxr_output_get(mdev);
for (i = 0; i < MXR_MAX_SUB_MIXERS; ++i) {
sub_mxr = &mdev->sub_mxr[i];
if (sub_mxr->local) {
layer = sub_mxr->layer[MXR_LAYER_VIDEO];
mxr_layer_geo_fix(layer);
layer->ops.format_set(layer);
layer->ops.stream_set(layer, 1);
local += sub_mxr->local;
}
}
/* Set the TVOUT register about gsc-mixer local path */
mxr_reg_local_path_set(mdev, mdev->mxr0_gsc, mdev->mxr1_gsc, mdev->flags);
}
/* Alpha blending configuration always can be changed
* whenever streaming */
mxr_set_alpha_blend(mdev);
if ((mdev->n_streamer == 1 && local == 1) ||
(mdev->n_streamer == 2 && local == 2)) {
for (i = MXR_PAD_SOURCE_GSCALER; i < MXR_PADS_NUM; ++i) {
pad = &sd->entity.pads[i];
/* find sink pad of output via enabled link*/
pad = media_entity_remote_source(pad);
if (pad)
if (media_entity_type(pad->entity)
== MEDIA_ENT_T_V4L2_SUBDEV)
break;
if (i == MXR_PAD_SOURCE_GRP1)
return -ENODEV;
}
sd = media_entity_to_v4l2_subdev(pad->entity);
mxr_dbg(mdev, "cookie of current output = (%d)\n",
to_output(mdev)->cookie);
#if defined(CONFIG_CPU_EXYNOS4210)
if (to_output(mdev)->cookie == 0)
clk_set_parent(res->sclk_mixer, res->sclk_dac);
else
clk_set_parent(res->sclk_mixer, res->sclk_hdmi);
#endif
mxr_reg_s_output(mdev, to_output(mdev)->cookie);
ret = v4l2_subdev_call(sd, video, g_mbus_fmt, &mbus_fmt);
if (ret) {
mxr_err(mdev, "failed to get mbus_fmt for output %s\n",
sd->name);
return ret;
}
mxr_reg_set_mbus_fmt(mdev, &mbus_fmt);
ret = v4l2_subdev_call(sd, video, s_mbus_fmt, &mbus_fmt);
if (ret) {
mxr_err(mdev, "failed to set mbus_fmt for output %s\n",
sd->name);
return ret;
}
mxr_reg_streamon(mdev);
ret = v4l2_subdev_call(sd, video, s_stream, 1);
if (ret) {
mxr_err(mdev, "starting stream failed for output %s\n",
sd->name);
return ret;
}
ret = mxr_reg_wait4vsync(mdev);
if (ret) {
mxr_err(mdev, "failed to get vsync (%d) from output\n",
ret);
return ret;
}
}
mutex_unlock(&mdev->s_mutex);
mxr_reg_dump(mdev);
return 0;
}
static int mxr_streamer_put(struct mxr_device *mdev, struct v4l2_subdev *sd)
{
int ret, i;
int local = 1;
struct media_pad *pad;
struct sub_mxr_device *sub_mxr;
struct mxr_layer *layer;
struct v4l2_subdev *hdmi_sd;
struct v4l2_subdev *gsc_sd;
struct exynos_entity_data *md_data;
mutex_lock(&mdev->s_mutex);
--mdev->n_streamer;
mxr_dbg(mdev, "%s(%d)\n", __func__, mdev->n_streamer);
/* distinction number of local path */
if (mdev->mxr_data_from == FROM_GSC_SD) {
local = 0;
for (i = 0; i < MXR_MAX_SUB_MIXERS; ++i) {
sub_mxr = &mdev->sub_mxr[i];
if (sub_mxr->local) {
local += sub_mxr->local;
}
}
}
if ((mdev->n_streamer == 0 && local == 1) ||
(mdev->n_streamer == 1 && local == 2)) {
for (i = MXR_PAD_SOURCE_GSCALER; i < MXR_PADS_NUM; ++i) {
pad = &sd->entity.pads[i];
/* find sink pad of output via enabled link*/
pad = media_entity_remote_source(pad);
if (pad)
if (media_entity_type(pad->entity)
== MEDIA_ENT_T_V4L2_SUBDEV)
break;
if (i == MXR_PAD_SOURCE_GRP1)
return -ENODEV;
}
hdmi_sd = media_entity_to_v4l2_subdev(pad->entity);
mxr_reg_streamoff(mdev);
/* vsync applies Mixer setup */
ret = mxr_reg_wait4vsync(mdev);
if (ret) {
mxr_err(mdev, "failed to get vsync (%d) from output\n",
ret);
return ret;
}
}
/* When using local path between gscaler and mixer, below stop sequence
* must be processed */
if (mdev->mxr_data_from == FROM_GSC_SD) {
pad = &sd->entity.pads[MXR_PAD_SINK_GSCALER];
pad = media_entity_remote_source(pad);
if (pad) {
gsc_sd = media_entity_to_v4l2_subdev(
pad->entity);
mxr_dbg(mdev, "stop from %s\n", gsc_sd->name);
md_data = (struct exynos_entity_data *)
gsc_sd->dev_priv;
md_data->media_ops->power_off(gsc_sd);
}
}
if ((mdev->n_streamer == 0 && local == 1) ||
(mdev->n_streamer == 1 && local == 2)) {
ret = v4l2_subdev_call(hdmi_sd, video, s_stream, 0);
if (ret) {
mxr_err(mdev, "stopping stream failed for output %s\n",
hdmi_sd->name);
return ret;
}
}
/* turn off connected output device through link
* with mixer */
if (mdev->mxr_data_from == FROM_GSC_SD) {
for (i = 0; i < MXR_MAX_SUB_MIXERS; ++i) {
sub_mxr = &mdev->sub_mxr[i];
if (sub_mxr->local) {
layer = sub_mxr->layer[MXR_LAYER_VIDEO];
layer->ops.stream_set(layer, 0);
}
}
mxr_output_put(mdev);
/* disable mixer clock */
mxr_power_put(mdev);
}
WARN(mdev->n_streamer < 0, "negative number of streamers (%d)\n",
mdev->n_streamer);
mutex_unlock(&mdev->s_mutex);
mxr_reg_dump(mdev);
return 0;
}
