/***************************************************************************
 *             __________               __   ___.
 *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
 *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
 *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
 *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
 *                     \/            \/     \/    \/            \/
 * $Id$
 *
 * Copyright (C) 2007 by Karl Kurbjun
 *
 * Some of this is based on the Cowon A2 Firmware release:
 * http://www.cowonglobal.com/download/gnu/cowon_pmp_a2_src_1.59_GPL.tar.gz
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
 * KIND, either express or implied.
 *
 ****************************************************************************/

#include "config.h"
#include "cpu.h"
#include "string.h"
#include "lcd.h"
#include "kernel.h"
#include "memory.h"
#include "system-target.h"
#include "lcd.h"
#include "lcd-target.h"

/* Copies a rectangle from one framebuffer to another. Can be used in
   single transfer mode with width = num pixels, and height = 1 which
   allows a full-width rectangle to be copied more efficiently. */
extern void lcd_copy_buffer_rect(fb_data *dst, const fb_data *src,
                                 int width, int height);

static bool lcd_on = true;
#if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
static bool lcd_powered = true;
#endif

/*
** These are imported from lcd-16bit.c
*/
extern unsigned fg_pattern;
extern unsigned bg_pattern;

#if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
bool lcd_active(void)
{
    return lcd_on;
}
#endif

#if defined(HAVE_LCD_SLEEP)
void lcd_sleep()
{
    if (lcd_powered)
    {
        /* "not powered" implies "disabled" */
        if (lcd_on)
            lcd_enable(false);
            
        /* Disabling these saves another ~15mA */
        IO_OSD_OSDWINMD0&=~(0x01);
		IO_VID_ENC_VMOD&=~(0x01);
    	
    	sleep(HZ/5);
    	
    	/* Disabling the LCD saves ~50mA */
    	IO_GIO_BITCLR2=1<<4;
    	lcd_powered=false;
    }
}
#endif

#if defined(HAVE_LCD_ENABLE)
void lcd_enable(bool state)
{
    if (state == lcd_on)
        return;

    if(state)
    {
        /* "enabled" implies "powered" */
        if (!lcd_powered)
        {
        	lcd_powered=true;
        	
        	IO_OSD_OSDWINMD0|=0x01;
			IO_VID_ENC_VMOD|=0x01;
    	
    		sleep(2);
            IO_GIO_BITSET2=1<<4;
            /* Wait long enough for a frame to be written - yes, it
             * takes awhile. */
            sleep(HZ/5);
        }

        lcd_on = true;
        lcd_update();
        lcd_activation_call_hook();
    }
    else 
    {
        lcd_on = false;
    }
}
#endif

/* Note this is expecting a screen size of 480x640 or 240x320, other screen
 * sizes need to be considered for fudge factors
 */
#define LCD_FUDGE LCD_NATIVE_WIDTH%32

/* LCD init - based on code from ingenient-bsp/bootloader/board/dm320/splash.c
 *  and code by Catalin Patulea from the M:Robe 500i linux port
 */
void lcd_init_device(void)
{
    unsigned int addr;
    
    /* Clear the Frame */
    memset16(FRAME, 0x0000, LCD_WIDTH*LCD_HEIGHT);

	IO_OSD_OSDWINMD0&=~(0x0001);
	IO_OSD_VIDWINMD&=~(0x0001);

	/* Setup the LCD controller */
	IO_VID_ENC_VMOD=0x2014;
	IO_VID_ENC_VDCTL=0x2000;
	IO_VID_ENC_VDPRO=0x0000;
	IO_VID_ENC_SYNCTL=0x100E;
	IO_VID_ENC_HSPLS=1; /* HSYNC pulse width */
	IO_VID_ENC_VSPLS=1; /* VSYNC pulse width */
	
	/* These calculations support 640x480 and 320x240 (based on OF) */
	IO_VID_ENC_HINT=LCD_NATIVE_WIDTH+LCD_NATIVE_WIDTH/3;
	IO_VID_ENC_HSTART=LCD_NATIVE_WIDTH/6; /* Front porch */
	IO_VID_ENC_HVALID=LCD_NATIVE_WIDTH; /* Data valid */
	IO_VID_ENC_VINT=LCD_NATIVE_HEIGHT+7;
	IO_VID_ENC_VSTART=3;
	IO_VID_ENC_VVALID=LCD_NATIVE_HEIGHT;
	
	IO_VID_ENC_HSDLY=0x0000;
	IO_VID_ENC_VSDLY=0x0000;
	IO_VID_ENC_YCCTL=0x0000;
	IO_VID_ENC_RGBCTL=0x0000;
	IO_VID_ENC_RGBCLP=0xFF00;
	IO_VID_ENC_LNECTL=0x0000;
	IO_VID_ENC_CULLLNE=0x0000;
	IO_VID_ENC_LCDOUT=0x0000;
	IO_VID_ENC_BRTS=0x0000;
	IO_VID_ENC_BRTW=0x0000;
	IO_VID_ENC_ACCTL=0x0000;
	IO_VID_ENC_PWMP=0x0000;
	IO_VID_ENC_PWMW=0x0000;
	
	IO_VID_ENC_DCLKPTN0=0x0001;

	/* Setup the display */
    IO_OSD_MODE=0x00ff;
    
    IO_OSD_ATRMD=0x0000;
    IO_OSD_RECTCUR=0x0000;
    
    IO_OSD_BASEPX=IO_VID_ENC_HSTART;
    IO_OSD_BASEPY=IO_VID_ENC_VSTART;
    
    addr = ((int)FRAME-CONFIG_SDRAM_START) / 32;

    /* Setup the OSD windows */
    
    /* Used for 565 RGB */
    IO_OSD_OSDWINMD0=0x30C0;

    IO_OSD_OSDWIN0OFST=LCD_NATIVE_WIDTH / 16;
    
    IO_OSD_OSDWINADH=addr >> 16;
    IO_OSD_OSDWIN0ADL=addr & 0xFFFF;

    IO_OSD_OSDWIN0XP=0;
    IO_OSD_OSDWIN0YP=0;
    
    /* read from OF */
    IO_OSD_OSDWIN0XL=LCD_NATIVE_WIDTH;
    IO_OSD_OSDWIN0YL=LCD_NATIVE_HEIGHT;
    
    /* Unused */
    IO_OSD_OSDWINMD1=0x10C0;
    
#if LCD_NATIVE_WIDTH%32!=0
    IO_OSD_OSDWIN1OFST=LCD_NATIVE_WIDTH / 32+1;
#else
    IO_OSD_OSDWIN1OFST=LCD_NATIVE_WIDTH / 32;
#endif

    IO_OSD_OSDWIN1ADL=addr & 0xFFFF;
    
    IO_OSD_OSDWIN1XP=0;
    IO_OSD_OSDWIN1YP=0;
    
    IO_OSD_OSDWIN1XL=LCD_NATIVE_WIDTH;
    IO_OSD_OSDWIN1YL=LCD_NATIVE_HEIGHT;
    
    IO_OSD_VIDWINMD=0x0002;
    
    addr = ((int)FRAME2-CONFIG_SDRAM_START) / 32;
    
    /* This is a bit messy, the LCD transfers appear to happen in chunks of 32
     * pixels. (based on OF)
     */
#if LCD_NATIVE_WIDTH%32!=0
    IO_OSD_VIDWIN0OFST=LCD_NATIVE_WIDTH / 32+1;
#else
    IO_OSD_VIDWIN0OFST=LCD_NATIVE_WIDTH / 32;
#endif
    
    IO_OSD_VIDWINADH=addr >> 16;
    IO_OSD_VIDWIN0ADL=addr & 0xFFFF;
    
    IO_OSD_VIDWIN0XP=0;
    IO_OSD_VIDWIN0YP=0;
    
    IO_OSD_VIDWIN0XL=LCD_NATIVE_WIDTH;
    IO_OSD_VIDWIN0YL=LCD_NATIVE_HEIGHT;

    /* Set pin 36 and 35 (LCD POWER and LCD RESOLUTION) to an output */
    IO_GIO_DIR2&=!(3<<3);
    
#if LCD_NATIVE_HEIGHT > 320
	/* Set LCD resolution to VGA */
    IO_GIO_BITSET2=1<<3;
#else
	/* Set LCD resolution to QVGA */
	IO_GIO_BITCLR2=1<<3;
#endif

	IO_OSD_OSDWINMD0|=0x01;
	IO_VID_ENC_VMOD|=0x01;
}

#if defined(HAVE_LCD_MODES)
void lcd_set_mode(int mode)
{
	if(mode==LCD_MODE_YUV)
	{
		/* Turn off the RGB buffer and enable the YUV buffer */
		IO_OSD_OSDWINMD0 |=0x04;
		IO_OSD_VIDWINMD  |=0x01;
		memset16(FRAME2, 0x0080, LCD_NATIVE_HEIGHT*(LCD_NATIVE_WIDTH+LCD_FUDGE));
	}
	else if(mode==LCD_MODE_RGB565)
	{
		/* Turn on the RGB window, set it to 16 bit and turn YUV window off */
		IO_OSD_VIDWINMD  &=~(0x01);
		IO_OSD_OSDWIN0OFST=LCD_NATIVE_WIDTH / 16;
    	IO_OSD_OSDWINMD0 |=(1<<13);
    	IO_OSD_OSDWINMD0 &=~0x04;
    	lcd_clear_display();
	}
	else if(mode==LCD_MODE_PAL256)
	{
#if LCD_NATIVE_WIDTH%32!=0
        IO_OSD_OSDWIN0OFST=LCD_NATIVE_WIDTH / 32+1;
#else
        IO_OSD_OSDWIN0OFST=LCD_NATIVE_WIDTH / 32;
#endif

        IO_OSD_VIDWINMD  &=~(0x01);
        IO_OSD_OSDWINMD0 &=~(1<<13);
		IO_OSD_OSDWINMD0 |=0x01;
	}
}
#endif

/* Update a fraction of the display. */
void lcd_update_rect(int x, int y, int width, int height)
{
    register fb_data *dst, *src;

    if (!lcd_on)
        return;

    if ( (width | height) < 0)
        return; /* nothing left to do */

    if (x + width > LCD_WIDTH)
        width = LCD_WIDTH - x; /* Clip right */
    if (x < 0)
        width += x, x = 0; /* Clip left */

    if (y + height > LCD_HEIGHT)
        height = LCD_HEIGHT - y; /* Clip bottom */
    if (y < 0)
        height += y, y = 0; /* Clip top */


    src = &lcd_framebuffer[y][x];

#if CONFIG_ORIENTATION == SCREEN_PORTRAIT
    dst = (fb_data *)FRAME + LCD_WIDTH*y + x;

    /* Copy part of the Rockbox framebuffer to the second framebuffer */
    if (width < LCD_WIDTH)
    {
        /* Not full width - do line-by-line */
        lcd_copy_buffer_rect(dst, src, width, height);
    }
    else
    {
        /* Full width - copy as one line */
        lcd_copy_buffer_rect(dst, src, LCD_WIDTH*height, 1);
    }
#else
    dst=FRAME + (LCD_NATIVE_WIDTH*(LCD_NATIVE_HEIGHT-1)) 
        - LCD_NATIVE_WIDTH*x + y ;

    while(height--)
    {
        register int c_width=width;
        register fb_data *c_dst=dst;
        
        while(c_width--)
        {
            *c_dst=*src++;
            c_dst-=LCD_NATIVE_WIDTH;
        }
        
        src+=LCD_WIDTH-width;
        dst++;
    }
    
#endif
}

/* Update the display.
   This must be called after all other LCD functions that change the display. */
void lcd_update(void)
{
    if (!lcd_on)
        return;
	
#if CONFIG_ORIENTATION == SCREEN_PORTRAIT
    lcd_copy_buffer_rect((fb_data *)FRAME, &lcd_framebuffer[0][0],
                         LCD_WIDTH*LCD_HEIGHT, 1);
#else
    lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT);
#endif
}

#if defined(HAVE_LCD_MODES) && (HAVE_LCD_MODES & LCD_MODE_PAL256)
void lcd_blit_pal256(unsigned char *src, int src_x, int src_y, int x, int y,
	int width, int height)
{
#if CONFIG_ORIENTATION == SCREEN_PORTRAIT
	char *dst=(char *)FRAME+x+y*(LCD_NATIVE_WIDTH+LCD_FUDGE);
	
	src=src+src_x+src_y*LCD_NATIVE_WIDTH;
	while(height--);
	{
		memcpy ( dst, src, width);
		
		dst=dst+(LCD_NATIVE_WIDTH-x+LCD_FUDGE); 
		src+=width;
	}
	
#else
	char *dst=(char *)FRAME
	    + (LCD_NATIVE_WIDTH+LCD_FUDGE)*(LCD_NATIVE_HEIGHT-1)
	    - (LCD_NATIVE_WIDTH+LCD_FUDGE)*x + y;
	
	src=src+src_x+src_y*LCD_WIDTH;
	while(height--)
	{
	    register char *c_dst=dst;
	    register int c_width=width;
	    
		while (c_width--)
		{
		    *c_dst=*src++;
		    c_dst=c_dst-(LCD_NATIVE_WIDTH+LCD_FUDGE);
		} 
		
		dst++;
		src+=LCD_WIDTH-width;
	}
#endif
}

void lcd_pal256_update_pal(fb_data *palette)
{
	unsigned char i;
	for(i=0; i< 255; i++) 
	{
	    int y, cb, cr;
		unsigned char r=RGB_UNPACK_RED_LCD(palette[i])<<3;
		unsigned char g=RGB_UNPACK_GREEN_LCD(palette[i])<<2;
		unsigned char b=RGB_UNPACK_BLUE_LCD(palette[i])<<3;
        
        y = ((77 * r + 150 * g + 29 * b) >> 8);
        cb = ((-43 * r - 85 * g + 128 * b) >> 8) + 128;
        cr = ((128 * r - 107 * g - 21 * b) >> 8) + 128;
		
        while(IO_OSD_MISCCTL&0x08)
        {};
		
		/* Write in y and cb */
       	IO_OSD_CLUTRAMYCB= ((unsigned char)y << 8) | (unsigned char)cb;
		
		/* Write in the index and cr */
       	IO_OSD_CLUTRAMCR=((unsigned char)cr << 8) | i;
	}
}
#endif
	
void lcd_blit_yuv(unsigned char * const src[3],
                  int src_x, int src_y, int stride,
                  int x, int y, int width, 
                  int height) __attribute__ ((section(".icode")));
                                           
/* Performance function to blit a YUV bitmap directly to the LCD */
/* Show it rotated so the LCD_WIDTH is now the height */
void lcd_blit_yuv(unsigned char * const src[3],
                  int src_x, int src_y, int stride,
                  int x, int y, int width, int height)
{
    register unsigned char const * yuv_src[3];

    if (!lcd_on)
        return;
	
    /* y has to be at multiple of 2 or else it will mess up the HW
     * (interleaving) 
     */
    y &= ~1;

    if(     ((y | x | height | width ) < 0) 
            || y>LCD_NATIVE_HEIGHT || x>LCD_NATIVE_WIDTH )
        return;

    if(y+height>LCD_NATIVE_WIDTH)
    {
        height=LCD_NATIVE_WIDTH-y;
    }
    if(x+width>LCD_NATIVE_HEIGHT)
    {
        width=LCD_NATIVE_HEIGHT-x;
    }

    /* Sorry, but width and height must be >= 2 or else */
    width &= ~1;
    height>>=1;

    fb_data * dst = FRAME2 
        + ((LCD_NATIVE_WIDTH+LCD_FUDGE)*(LCD_NATIVE_HEIGHT-1)) 
        - (LCD_NATIVE_WIDTH+LCD_FUDGE)*x + y ;

    /* Scope z */
    {
        off_t z;
        z = stride*src_y;
        yuv_src[0] = src[0] + z + src_x;
        yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1);
        yuv_src[2] = src[2] + (yuv_src[1] - src[1]);
    }

    register int cbcr_remain=(stride>>1)-(width>>1);
    register int y_remain=(stride<<1)-width;
    do
    {
    	register fb_data *c_dst=dst;
    	register int c_width=width;

    	do
    	{
    	    /* This needs to be done in a block of 4 pixels */
    	    
    		*c_dst=*yuv_src[0]<<8 | *yuv_src[1];
    		*(c_dst+1)=*(yuv_src[0]+stride)<<8 | *yuv_src[2];
    		c_dst-=(LCD_NATIVE_WIDTH+LCD_FUDGE);
    		
    		yuv_src[0]++;
    		
    		*c_dst=*yuv_src[0]<<8 | *yuv_src[1];
    		*(c_dst+1)=*(yuv_src[0]+stride)<<8 | *yuv_src[2];
    		c_dst-=(LCD_NATIVE_WIDTH+LCD_FUDGE);
    		
            yuv_src[0]++;
            
        	yuv_src[1]++;
        	yuv_src[2]++;
        	
    		c_width -= 2;
		}
		while (c_width > 0);
		
		yuv_src[0] += y_remain; /* Skip down two luma lines-width */
        yuv_src[1] += cbcr_remain; /* Skip down one chroma line-width/2 */
        yuv_src[2] += cbcr_remain;
        dst+=2;
    }
    while (--height > 0);
}

void lcd_set_contrast(int val) {
  (void) val;
  // TODO:
}

void lcd_set_invert_display(bool yesno) {
  (void) yesno;
  // TODO:
}

void lcd_set_flip(bool yesno) {
  (void) yesno;
  // TODO:
}