/
ssc.c
81 lines (73 loc) · 1.93 KB
/
ssc.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
#define wr(reg, val) *(volatile unsigned *)(reg) = (val)
#define rd(reg) (*(volatile unsigned *)(reg))
#define MPEG_PLL_CONTROL2 0x01100580
#define MPEG_PLL_CONTROL3 0x01100584
#define VIDEO_PLL_CONTROL2 0x01100590
#define VIDEO_PLL_CONTROL3 0x01100594
static void set_mpeg_pll_ssc(unsigned cmod_clk_sel, unsigned pll_cmod_ctr)
{
unsigned temp = rd(MPEG_PLL_CONTROL2);
temp &= ~(0xf<<12 | 0xf<<6);
temp |= (((cmod_clk_sel & 0xf)<<12) | ((pll_cmod_ctr & 0xf)<<6));
wr(MPEG_PLL_CONTROL2, temp);
}
static void set_video_pll_ssc(unsigned cmod_clk_sel, unsigned pll_cmod_ctr)
{
unsigned temp = rd(VIDEO_PLL_CONTROL2);
temp &= ~(0xf<<12 | 0xf<<6);
temp |= (((cmod_clk_sel & 0xf)<<12) | ((pll_cmod_ctr & 0xf)<<6));
wr(VIDEO_PLL_CONTROL2, temp);
}
void Set_MPEG_SSC(unsigned char level)
{
switch(level)
{
case 1:
set_mpeg_pll_ssc(8,4);
break;
case 2:
set_mpeg_pll_ssc(8,6);
break;
case 3:
set_mpeg_pll_ssc(8,8);
break;
case 4:
set_mpeg_pll_ssc(4,6);
break;
case 5:
set_mpeg_pll_ssc(2,9);
break;
default:
break;
}
wr(MPEG_PLL_CONTROL3, 0x103);
}
void Set_VIDEO_SSC(unsigned char level)
{
switch(level)
{
case 1:
set_video_pll_ssc(8,7);
break;
case 2:
set_video_pll_ssc(4,11);
break;
case 3:
set_video_pll_ssc(2,7);
break;
case 4:
set_video_pll_ssc(2,9);
break;
case 5:
set_video_pll_ssc(2,12);
break;
default:
break;
}
wr(VIDEO_PLL_CONTROL3, 0x103);
}
void Set_SSC(unsigned char level)
{
Set_VIDEO_SSC(level);
Set_MPEG_SSC(level);
}