#include "s3c_board.h"
|
#include "s3c2440.h"
|
|
unsigned int s3c2440_get_fclk(void)
|
{
|
struct s3c2440_clock_power *clk_power = s3c2440_get_base_clock_power();
|
unsigned int r, m, p, s;
|
|
r = clk_power->MPLLCON;
|
|
m = ((r & 0xFF000) >> 12) + 8;
|
p = ((r & 0x003F0) >> 4) + 2;
|
s = r & 0x3;
|
|
return (SYS_CLK_FREQ * m * 2) / (p << s);
|
}
|
|
unsigned int s3c2440_get_hclk(void)
|
{
|
struct s3c2440_clock_power * const clk_power = s3c2440_get_base_clock_power();
|
unsigned int fclk = s3c2440_get_fclk();
|
|
if (clk_power->CLKDIVN & 0x6)
|
{
|
if ((clk_power->CLKDIVN & 0x6)==2)
|
return fclk/2;
|
if ((clk_power->CLKDIVN & 0x6)==6)
|
return (clk_power->CAMDIVN & 0x100) ? fclk/6 : fclk/3;
|
if ((clk_power->CLKDIVN & 0x6)==4)
|
return (clk_power->CAMDIVN & 0x200) ? fclk/8 : fclk/4;
|
return fclk;
|
}
|
|
return fclk;
|
}
|
|
unsigned int s3c2440_get_pclk(void)
|
{
|
struct s3c2440_clock_power * const clk_power = s3c2440_get_base_clock_power();
|
unsigned int hclk = s3c2440_get_hclk();
|
|
return (clk_power->CLKDIVN & 0x1) ? hclk/2 : hclk;
|
}
|
|
unsigned int s3c2440_get_uclk(void)
|
{
|
struct s3c2440_clock_power *clk_power = s3c2440_get_base_clock_power();
|
unsigned int r, m, p, s;
|
|
r = clk_power->UPLLCON;
|
|
m = ((r & 0xFF000) >> 12) + 8;
|
p = ((r & 0x003F0) >> 4) + 2;
|
s = r & 0x3;
|
|
return (SYS_CLK_FREQ * m) / (p << s);
|
}
|
|
void s3c2440_set_baudrate(unsigned int baudrate, int index)
|
{
|
struct s3c2440_uart *uart = s3c2440_get_base_uart(index);
|
unsigned int reg = 0;
|
int i;
|
reg = s3c2440_get_pclk() / (16 * baudrate) - 1;
|
|
uart->UBRDIV = reg;
|
for (i = 0; i < 100; i++);
|
}
|
|
int s3c2440_serial_init(unsigned int baudrate, int index)
|
{
|
struct s3c2440_uart *uart = s3c2440_get_base_uart(index);
|
|
/* FIFO enable, Tx/Rx FIFO clear */
|
uart->UFCON = 0x07;
|
uart->UMCON = 0x0;
|
|
/* Normal,No parity,1 stop,8 bit */
|
uart->ULCON = 0x3;
|
/*
|
* tx=level,rx=edge,disable timeout int.,enable rx error int.,
|
* normal,interrupt or polling
|
*/
|
uart->UCON = (1<<8) | (1<<2) | (1<<0);
|
|
// uart->UMCON = 0x1; /* RTS up */
|
|
s3c2440_set_baudrate(baudrate, index);
|
|
return (0);
|
}
|
|
int s3c2440_serail_set_afc(int enable, int index)
|
{
|
if (index != S3C2440_UART0 || index != S3C2440_UART1)
|
return -1;
|
|
struct s3c2440_uart *uart = s3c2440_get_base_uart(index);
|
if (enable) {
|
uart->UMCON = (1<<4);
|
} else {
|
uart->UMCON = 0;
|
uart->UMCON = 0;
|
uart->UMCON = 0;
|
uart->UMCON = 1;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Read a single byte from the serial port. Returns 1 on success, 0
|
* otherwise. When the function is succesfull, the character read is
|
* written into its argument c.
|
*/
|
int s3c2440_serial_getc (int index)
|
{
|
struct s3c2440_uart *uart = s3c2440_get_base_uart(index);
|
|
/* wait for character to arrive */
|
//while (!(uart->UTRSTAT & 0x1));
|
while(!(uart->UFSTAT & 0x1F));
|
|
return uart->URXH & 0xff;
|
}
|
|
#if 0
|
static int hwflow = 0; /* turned off by default */
|
int hwflow_onoff(int on)
|
{
|
switch(on) {
|
case 0:
|
default:
|
break; /* return current */
|
case 1:
|
hwflow = 1; /* turn on */
|
break;
|
case -1:
|
hwflow = 0; /* turn off */
|
break;
|
}
|
return hwflow;
|
}
|
#endif
|
|
#if 0
|
static int be_quiet = 0;
|
void disable_putc(void)
|
{
|
be_quiet = 1;
|
}
|
|
void enable_putc(void)
|
{
|
be_quiet = 0;
|
}
|
#endif
|
|
|
/*
|
* Output a single byte to the serial port.
|
*/
|
void s3c2440_serial_putc (char c, int index)
|
{
|
struct s3c2440_uart *uart = s3c2440_get_base_uart(index);
|
|
/* wait for room in the tx FIFO */
|
//while ((!(uart->UTRSTAT & 0x2)));
|
while (uart->UFSTAT & (1<<14));
|
uart->UTXH = c;
|
}
|
|
|
void s3c2440_serial_puts(const char *s, int index)
|
{
|
while (*s)
|
{
|
if (*s == '\n') /* If \n, also do \r */
|
s3c2440_serial_putc('\r', index);
|
s3c2440_serial_putc (*s++, index);
|
}
|
}
|
|
|
void s3c2440_interrupt_enable(unsigned int mask)
|
{
|
mask = ~mask;
|
struct s3c2440_interrupt *interrupt = s3c2440_get_base_interrupt();
|
interrupt->INTMSK &= mask;
|
}
|
|
void s3c2440_interrupt_disable(unsigned int mask)
|
{
|
struct s3c2440_interrupt *interrupt = s3c2440_get_base_interrupt();
|
interrupt->INTMSK |= mask;
|
}
|
|
void s3c2440_sub_interrupt_enable(unsigned int mask)
|
{
|
mask = ~mask;
|
struct s3c2440_interrupt *interrupt = s3c2440_get_base_interrupt();
|
interrupt->INTSUBMSK &= mask;
|
}
|
|
void s3c2440_sub_interrupt_disable(unsigned int mask)
|
{
|
struct s3c2440_interrupt *interrupt = s3c2440_get_base_interrupt();
|
interrupt->INTSUBMSK |= mask;
|
}
|
|
|
|
|
