98 lines
2.9 KiB
C
98 lines
2.9 KiB
C
#include <stdio.h>
|
|
#include <hw/csr.h>
|
|
|
|
#include "pll.h"
|
|
|
|
/*
|
|
* Despite varying pixel clocks, we must keep the PLL VCO operating
|
|
* in the specified range of 400MHz - 1000MHz.
|
|
* This code can program two sets of DRP data:
|
|
* 1. with VCO operating at 20x the pixel clock (for 20MHz - 50MHz pixel clock)
|
|
* 2. with VCO operating at 10x the pixel clock (for 40MHz - 100MHz pixel clock)
|
|
*/
|
|
|
|
static const unsigned short int pll_config_20x[32] = {
|
|
0x0006, 0x0008, 0x0000, 0x4400, 0x1708, 0x0097, 0x0501, 0x8288,
|
|
0x4201, 0x0d90, 0x00a1, 0x0111, 0x1004, 0x2028, 0x0802, 0x2800,
|
|
0x0288, 0x8058, 0x020c, 0x0200, 0x1210, 0x400b, 0xfc21, 0x0b21,
|
|
0x7f5f, 0xc0eb, 0x472a, 0xc02a, 0x20b6, 0x0e96, 0x1002, 0xd6ce
|
|
};
|
|
|
|
static const unsigned short int pll_config_10x[32] = {
|
|
0x0006, 0x0008, 0x0000, 0x4400, 0x1708, 0x0097, 0x0901, 0x8118,
|
|
0x4181, 0x0d60, 0x00a1, 0x0111, 0x1004, 0x2028, 0x0802, 0x0608,
|
|
0x0148, 0x8018, 0x020c, 0x0200, 0x1210, 0x400b, 0xfc21, 0x0b22,
|
|
0x5fdf, 0x40eb, 0x472b, 0xc02a, 0x20b6, 0x0e96, 0x1002, 0xd6ce
|
|
};
|
|
|
|
static void program_data(const unsigned short *data)
|
|
{
|
|
int i;
|
|
|
|
/*
|
|
* Some bits of words 4 and 5 appear to depend on PLL location,
|
|
* so we start at word 6.
|
|
* PLLs also seem to dislike any write to the last words.
|
|
*/
|
|
for(i=6;i<32-5;i++) {
|
|
fb_driver_clocking_pll_adr_write(i);
|
|
fb_driver_clocking_pll_dat_w_write(data[i]);
|
|
fb_driver_clocking_pll_write_write(1);
|
|
while(!fb_driver_clocking_pll_drdy_read());
|
|
}
|
|
for(i=6;i<32-5;i++) {
|
|
dvisampler0_clocking_pll_adr_write(i);
|
|
dvisampler0_clocking_pll_dat_w_write(data[i]);
|
|
dvisampler0_clocking_pll_write_write(1);
|
|
while(!dvisampler0_clocking_pll_drdy_read());
|
|
}
|
|
for(i=6;i<32-5;i++) {
|
|
dvisampler1_clocking_pll_adr_write(i);
|
|
dvisampler1_clocking_pll_dat_w_write(data[i]);
|
|
dvisampler1_clocking_pll_write_write(1);
|
|
while(!dvisampler1_clocking_pll_drdy_read());
|
|
}
|
|
}
|
|
|
|
void pll_config_for_clock(int freq)
|
|
{
|
|
if(freq < 2000)
|
|
printf("Frequency too low for PLLs\n");
|
|
else if(freq < 4500)
|
|
program_data(pll_config_20x);
|
|
else if(freq < 10000)
|
|
program_data(pll_config_10x);
|
|
else
|
|
printf("Frequency too high for PLLs\n");
|
|
}
|
|
|
|
void pll_dump(void)
|
|
{
|
|
int i;
|
|
|
|
printf("framebuffer PLL:\n");
|
|
for(i=0;i<32;i++) {
|
|
fb_driver_clocking_pll_adr_write(i);
|
|
fb_driver_clocking_pll_read_write(1);
|
|
while(!fb_driver_clocking_pll_drdy_read());
|
|
printf("%04x ", fb_driver_clocking_pll_dat_r_read());
|
|
}
|
|
printf("\n");
|
|
printf("dvisampler0 PLL:\n");
|
|
for(i=0;i<32;i++) {
|
|
dvisampler0_clocking_pll_adr_write(i);
|
|
dvisampler0_clocking_pll_read_write(1);
|
|
while(!dvisampler0_clocking_pll_drdy_read());
|
|
printf("%04x ", dvisampler0_clocking_pll_dat_r_read());
|
|
}
|
|
printf("\n");
|
|
printf("dvisampler1 PLL:\n");
|
|
for(i=0;i<32;i++) {
|
|
dvisampler1_clocking_pll_adr_write(i);
|
|
dvisampler1_clocking_pll_read_write(1);
|
|
while(!dvisampler1_clocking_pll_drdy_read());
|
|
printf("%04x ", dvisampler1_clocking_pll_dat_r_read());
|
|
}
|
|
printf("\n");
|
|
}
|