Skip to content
体验新版
项目
组织
正在加载...
登录
切换导航
打开侧边栏
xiphi1978
linux
提交
e8523b64
L
linux
项目概览
xiphi1978
/
linux
通知
2
Star
0
Fork
0
代码
文件
提交
分支
Tags
贡献者
分支图
Diff
Issue
0
列表
看板
标记
里程碑
合并请求
0
Wiki
0
Wiki
分析
仓库
DevOps
项目成员
Pages
L
linux
项目概览
项目概览
详情
发布
仓库
仓库
文件
提交
分支
标签
贡献者
分支图
比较
Issue
0
Issue
0
列表
看板
标记
里程碑
合并请求
0
合并请求
0
Pages
分析
分析
仓库分析
DevOps
Wiki
0
Wiki
成员
成员
收起侧边栏
关闭侧边栏
动态
分支图
创建新Issue
提交
Issue看板
体验新版 GitCode,发现更多精彩内容 >>
提交
e8523b64
编写于
3月 18, 2009
作者:
M
Mark Brown
浏览文件
操作
浏览文件
下载
电子邮件补丁
差异文件
ASoC: Add FLL support for WM8400
Signed-off-by:
N
Mark Brown
<
broonie@opensource.wolfsonmicro.com
>
上级
24a51029
变更
1
显示空白变更内容
内联
并排
Showing
1 changed file
with
129 addition
and
0 deletion
+129
-0
sound/soc/codecs/wm8400.c
sound/soc/codecs/wm8400.c
+129
-0
未找到文件。
sound/soc/codecs/wm8400.c
浏览文件 @
e8523b64
...
...
@@ -70,6 +70,7 @@ struct wm8400_priv {
unsigned
int
sysclk
;
unsigned
int
pcmclk
;
struct
work_struct
work
;
int
fll_in
,
fll_out
;
};
static
inline
unsigned
int
wm8400_read
(
struct
snd_soc_codec
*
codec
,
...
...
@@ -931,6 +932,133 @@ static int wm8400_set_dai_sysclk(struct snd_soc_dai *codec_dai,
return
0
;
}
struct
fll_factors
{
u16
n
;
u16
k
;
u16
outdiv
;
u16
fratio
;
u16
freq_ref
;
};
#define FIXED_FLL_SIZE ((1 << 16) * 10)
static
int
fll_factors
(
struct
wm8400_priv
*
wm8400
,
struct
fll_factors
*
factors
,
unsigned
int
Fref
,
unsigned
int
Fout
)
{
u64
Kpart
;
unsigned
int
K
,
Nmod
,
target
;
factors
->
outdiv
=
2
;
while
(
Fout
*
factors
->
outdiv
<
90000000
||
Fout
*
factors
->
outdiv
>
100000000
)
{
factors
->
outdiv
*=
2
;
if
(
factors
->
outdiv
>
32
)
{
dev_err
(
wm8400
->
wm8400
->
dev
,
"Unsupported FLL output frequency %dHz
\n
"
,
Fout
);
return
-
EINVAL
;
}
}
target
=
Fout
*
factors
->
outdiv
;
factors
->
outdiv
=
factors
->
outdiv
>>
2
;
if
(
Fref
<
48000
)
factors
->
freq_ref
=
1
;
else
factors
->
freq_ref
=
0
;
if
(
Fref
<
1000000
)
factors
->
fratio
=
9
;
else
factors
->
fratio
=
0
;
/* Ensure we have a fractional part */
do
{
if
(
Fref
<
1000000
)
factors
->
fratio
--
;
else
factors
->
fratio
++
;
if
(
factors
->
fratio
<
1
||
factors
->
fratio
>
8
)
{
dev_err
(
wm8400
->
wm8400
->
dev
,
"Unable to calculate FRATIO
\n
"
);
return
-
EINVAL
;
}
factors
->
n
=
target
/
(
Fref
*
factors
->
fratio
);
Nmod
=
target
%
(
Fref
*
factors
->
fratio
);
}
while
(
Nmod
==
0
);
/* Calculate fractional part - scale up so we can round. */
Kpart
=
FIXED_FLL_SIZE
*
(
long
long
)
Nmod
;
do_div
(
Kpart
,
(
Fref
*
factors
->
fratio
));
K
=
Kpart
&
0xFFFFFFFF
;
if
((
K
%
10
)
>=
5
)
K
+=
5
;
/* Move down to proper range now rounding is done */
factors
->
k
=
K
/
10
;
dev_dbg
(
wm8400
->
wm8400
->
dev
,
"FLL: Fref=%d Fout=%d N=%x K=%x, FRATIO=%x OUTDIV=%x
\n
"
,
Fref
,
Fout
,
factors
->
n
,
factors
->
k
,
factors
->
fratio
,
factors
->
outdiv
);
return
0
;
}
static
int
wm8400_set_dai_pll
(
struct
snd_soc_dai
*
codec_dai
,
int
pll_id
,
unsigned
int
freq_in
,
unsigned
int
freq_out
)
{
struct
snd_soc_codec
*
codec
=
codec_dai
->
codec
;
struct
wm8400_priv
*
wm8400
=
codec
->
private_data
;
struct
fll_factors
factors
;
int
ret
;
u16
reg
;
if
(
freq_in
==
wm8400
->
fll_in
&&
freq_out
==
wm8400
->
fll_out
)
return
0
;
if
(
freq_out
!=
0
)
{
ret
=
fll_factors
(
wm8400
,
&
factors
,
freq_in
,
freq_out
);
if
(
ret
!=
0
)
return
ret
;
}
wm8400
->
fll_out
=
freq_out
;
wm8400
->
fll_in
=
freq_in
;
/* We *must* disable the FLL before any changes */
reg
=
wm8400_read
(
codec
,
WM8400_POWER_MANAGEMENT_2
);
reg
&=
~
WM8400_FLL_ENA
;
wm8400_write
(
codec
,
WM8400_POWER_MANAGEMENT_2
,
reg
);
reg
=
wm8400_read
(
codec
,
WM8400_FLL_CONTROL_1
);
reg
&=
~
WM8400_FLL_OSC_ENA
;
wm8400_write
(
codec
,
WM8400_FLL_CONTROL_1
,
reg
);
if
(
freq_out
==
0
)
return
0
;
reg
&=
~
(
WM8400_FLL_REF_FREQ
|
WM8400_FLL_FRATIO_MASK
);
reg
|=
WM8400_FLL_FRAC
|
factors
.
fratio
;
reg
|=
factors
.
freq_ref
<<
WM8400_FLL_REF_FREQ_SHIFT
;
wm8400_write
(
codec
,
WM8400_FLL_CONTROL_1
,
reg
);
wm8400_write
(
codec
,
WM8400_FLL_CONTROL_2
,
factors
.
k
);
wm8400_write
(
codec
,
WM8400_FLL_CONTROL_3
,
factors
.
n
);
reg
=
wm8400_read
(
codec
,
WM8400_FLL_CONTROL_4
);
reg
&=
WM8400_FLL_OUTDIV_MASK
;
reg
|=
factors
.
outdiv
;
wm8400_write
(
codec
,
WM8400_FLL_CONTROL_4
,
reg
);
return
0
;
}
/*
* Sets ADC and Voice DAC format.
*/
...
...
@@ -1188,6 +1316,7 @@ static struct snd_soc_dai_ops wm8400_dai_ops = {
.
set_fmt
=
wm8400_set_dai_fmt
,
.
set_clkdiv
=
wm8400_set_dai_clkdiv
,
.
set_sysclk
=
wm8400_set_dai_sysclk
,
.
set_pll
=
wm8400_set_dai_pll
,
};
/*
...
...
编辑
预览
Markdown
is supported
0%
请重试
或
添加新附件
.
添加附件
取消
You are about to add
0
people
to the discussion. Proceed with caution.
先完成此消息的编辑!
取消
想要评论请
注册
或
登录