shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-07 19:30:30 +09:00
Code Issues Packages Projects Releases Wiki Activity

media: i2c: rk628csi: adjust mclk use ppm instead of absolute value

Browse Source 
Signed-off-by: Shunhua Lan <lsh@rock-chips.com>
Change-Id: Ia72b9628553e2c754e6d35c366d1ba48feee7023
This commit is contained in:
Shunhua Lan
2021-09-28 12:08:54 +08:00
committed by Tao Huang
parent cfe05e46c9
commit 50cd86fb55
1 changed files with 22 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files

35
drivers/media/i2c/rk628_csi.c
View File

@@ -1296,17 +1296,6 @@ static void rk628_hdmirx_audio_clk_set_rate(struct v4l2_subdev *sd, u32 rate)
csi->audio_state.hdmirx_aud_clkrate = rate;
}
static void rk628_hdmirx_audio_clk_inc_rate(struct v4l2_subdev *sd, int dis)
{
struct rk628_csi *csi = to_csi(sd);
u32 hdmirx_aud_clkrate = csi->audio_state.hdmirx_aud_clkrate + dis;
v4l2_dbg(2, debug, sd, "%s: %u to %u\n",
__func__, csi->audio_state.hdmirx_aud_clkrate, hdmirx_aud_clkrate);
clk_set_rate(csi->clk_hdmirx_aud, hdmirx_aud_clkrate);
csi->audio_state.hdmirx_aud_clkrate = hdmirx_aud_clkrate;
}
static void rk628_hdmirx_audio_set_fs(struct v4l2_subdev *sd, u32 fs_audio)
{
struct rk628_csi *csi = to_csi(sd);
@@ -1320,6 +1309,26 @@ static void rk628_hdmirx_audio_set_fs(struct v4l2_subdev *sd, u32 fs_audio)
csi->audio_state.fs_audio = fs_audio;
}
static void rk628_hdmirx_audio_clk_ppm_inc(struct v4l2_subdev *sd, int ppm)
{
struct rk628_csi *csi = to_csi(sd);
int delta, rate, inc;
rate = csi->audio_state.hdmirx_aud_clkrate;
if (ppm < 0) {
ppm = -ppm;
inc = -1;
} else
inc = 1;
delta = (int)div64_u64((uint64_t)rate * ppm + 500000, 1000000);
delta *= inc;
rate = csi->audio_state.hdmirx_aud_clkrate + delta;
v4l2_dbg(2, debug, sd, "%s: %u to %u(delta:%d)\n",
__func__, csi->audio_state.hdmirx_aud_clkrate, rate, delta);
clk_set_rate(csi->clk_hdmirx_aud, rate);
csi->audio_state.hdmirx_aud_clkrate = rate;
}
static void rk628_hdmirx_audio_setup(struct v4l2_subdev *sd)
{
struct rk628_csi *csi = to_csi(sd);
@@ -1412,9 +1421,9 @@ static void rk628_csi_delayed_work_audio(struct work_struct *work)
csi->audio_present = false;
if ((cur_state - init_state) > 16 && (cur_state - pre_state) > 0)
rk628_hdmirx_audio_clk_inc_rate(sd, 10);
rk628_hdmirx_audio_clk_ppm_inc(sd, 10);
else if ((cur_state != 0) && (cur_state - init_state) < -16 && (cur_state - pre_state) < 0)
rk628_hdmirx_audio_clk_inc_rate(sd, -10);
rk628_hdmirx_audio_clk_ppm_inc(sd, -10);
audio_state->pre_state = cur_state;
exit:
schedule_delayed_work(&csi->delayed_work_audio, msecs_to_jiffies(1000));