#include <arm/s3c2xx0/s3c2800reg.h>
#define EXTINTR_INIT ((EXTINTR_HIGH|EXTINTR_FALLING)<<28) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<24) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<20) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<16) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<12) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<8) | \
((EXTINTR_HIGH|EXTINTR_FALLING)<<4) | \
((EXTINTR_HIGH|EXTINTR_FALLING))
#define FCLK 200000000
#define F_1MHZ 1000000
#define IOW(a, d) (*(volatile unsigned int *)(a) = (d))
#define IOR(a) (*(volatile unsigned int *)(a))
#define SETLED(d) IOW(S3C2800_GPIO_BASE+GPIO_PDATC,(d))
void smdk2800_io_init(void);
void
smdk2800_io_init(void)
{
unsigned int hclk;
unsigned int pclk;
unsigned int tmdat;
#define O PCON_OUTPUT
#define I PCON_INPUT
#define A PCON_ALTFUN
#define _ 0
#define _C(b7,b6,b5,b4,b3,b2,b1,b0) \
((b7<<14)|(b6<<12)|(b5<<10)|(b4<<8)|(b3<<6)|(b2<<4)|(b1<<2)|(b0<<0))
IOW(S3C2800_GPIO_BASE+GPIO_PCONA, _C(O,O,A,A,A,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PUPA, 0xff);
IOW(S3C2800_GPIO_BASE+GPIO_PCONB, _C(I,O,A,A,A,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PCONC, _C(_,_,_,_,O,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PUPC, 0xff);
IOW(S3C2800_GPIO_BASE+GPIO_PCOND, _C(A,A,A,A,A,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PUPD, 0xff);
IOW(S3C2800_GPIO_BASE+GPIO_PCONE, _C(O,O,O,O,A,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PUPE, 0xff);
IOW(S3C2800_GPIO_BASE+GPIO_PCONF, _C(A,A,A,A,A,A,A,A));
IOW(S3C2800_GPIO_BASE+GPIO_PUPF, 0xff);
IOW(S3C2800_GPIO_BASE+GPIO_EXTINTR, EXTINTR_INIT);
#undef O
#undef I
#undef A
#undef _
#undef _C
if(IOR(S3C2800_CLKMAN_BASE+CLKMAN_CLKCON) & CLKCON_HCLK)
hclk = FCLK / 2;
else
hclk = FCLK;
if(IOR(S3C2800_CLKMAN_BASE+CLKMAN_CLKCON) & CLKCON_PCLK)
pclk = hclk / 2;
else
pclk = hclk;
if((pclk/F_1MHZ) < 1)
tmdat = 1<<16;
else
tmdat = (pclk/F_1MHZ)<<16;
#define TMDAT_INIT 0xf424
IOW(S3C2800_TIMER0_BASE+TIMER_TMDAT, (tmdat | TMDAT_INIT));
IOW(S3C2800_TIMER1_BASE+TIMER_TMDAT, (tmdat | TMDAT_INIT));
IOW(S3C2800_TIMER2_BASE+TIMER_TMDAT, (tmdat | TMDAT_INIT));
IOW(S3C2800_TIMER0_BASE+TIMER_TMCON, TMCON_MUX_DIV32 | TMCON_INTENA | TMCON_ENABLE);
IOW(S3C2800_TIMER1_BASE+TIMER_TMCON, TMCON_MUX_DIV16 | TMCON_INTENA | TMCON_ENABLE);
IOW(S3C2800_TIMER2_BASE+TIMER_TMCON, TMCON_MUX_DIV8 | TMCON_INTENA | TMCON_ENABLE);
IOW(S3C2800_INTCTL_BASE+INTCTL_INTMOD, 0);
IOW(S3C2800_INTCTL_BASE+INTCTL_INTMSK, 0);
SETLED(0x0);
}