#include "r2d/lcds/c139/colors.h"

void c139_uwire_xmit(UINT16 cmd)
{
	* (volatile UINT16 *) TDR = cmd << 7;
	* (volatile UINT16 *) CSR |= NB_BITS_WR_9 + CS_CMD + START ; // transmit command data
	while (((* (volatile UINT16 *) CSR) & CSRB) != 0 ); // wait for end of WRITE
	* (volatile UINT16 *) CSR &= ~CS_CMD; // clears Chip Select 	
}

void c139_lcd_ctrl_cmd(UINT8 cmd, UINT8 param)
{
	c139_uwire_xmit(cmd);
	c139_uwire_xmit(param | 0x100);
}

void c139_set_lcd_addr_region(UINT8 xstart, UINT8 xend,
				UINT8 ystart, UINT8 yend)
{
	c139_lcd_ctrl_cmd(0x10, xstart);
	c139_lcd_ctrl_cmd(0x11, ystart);
	c139_lcd_ctrl_cmd(0x12, xend);
	c139_lcd_ctrl_cmd(0x13, yend);
	c139_lcd_ctrl_cmd(0x14, xstart);
	c139_lcd_ctrl_cmd(0x15, ystart);
}

void c139_lcd_send_pix(UINT16 pixval)
{
	c139_uwire_xmit((pixval >> 8) | 0x100);
	c139_uwire_xmit((pixval & 0xFF) | 0x100);
}

void r2d_lcd_power_on(void)
{
}

void r2d_lcd_power_off(void)
{
}

void r2d_refresh(void)
{
	UINT16 i, j, k;
	UINT32 v;
	UINT32 *p;
	INT16 y1, y2;

	p=r2d_g_framebuffer->p_memory_words;
    
	y1=r2d_update_ul_y; //0
	y2=r2d_update_br_y; //63

	if (y1 > y2)
		return;
	r2d_reinit_update_region();

	/* set window area */
	c139_set_lcd_addr_region(0, 95, y1, y2);

	p=p+y1*R2D_MWWIDTH;

	for (i=y1;i<=y2;i++)
	{
		for (j = 0; j < R2D_MWWIDTH-1; j++)
		{
			v=*p++;
			for (k=0;k<32;k++)
			{
				if (v&1)
					c139_lcd_send_pix(LCD16_COLOR_BLACK);
				else
					c139_lcd_send_pix(LCD16_COLOR_WHITE);
				v=v>>1;
			}
		}	    
		p++;
	} 
}