rockbox/firmware/target/coldfire/iaudio/x5/lcd-remote-x5.c
Jens Arnold 5cc95ad16d X5: Assembler optimised remote LCD update. Speedup: 3 times @11MHz, 3.3 times @45MHz, +75% @124MHz.
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@10685 a1c6a512-1295-4272-9138-f99709370657
2006-08-22 05:50:05 +00:00

459 lines
15 KiB
C
Executable file

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2006 by Linus Nielsen Feltzing
*
* All files in this archive are subject to the GNU General Public License.
* See the file COPYING in the source tree root for full license agreement.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include "config.h"
#include "system.h"
#include "kernel.h"
#include "lcd-remote.h"
/* The LCD in the iAudio M3/M5/X5 remote control is a Tomato LSI 0350 */
#define LCD_SET_DUTY_RATIO 0x48
#define LCD_SELECT_ADC 0xa0
#define LCD_SELECT_SHL 0xc0
#define LCD_SET_COM0 0x44
#define LCD_OSC_ON 0xab
#define LCD_SELECT_DCDC 0x64
#define LCD_SELECT_RES 0x20
#define LCD_SET_VOLUME 0x81
#define LCD_SET_BIAS 0x50
#define LCD_CONTROL_POWER 0x28
#define LCD_DISPLAY_ON 0xae
#define LCD_SET_INITLINE 0x40
#define LCD_SET_COLUMN 0x10
#define LCD_SET_PAGE 0xb0
#define LCD_SET_GRAY 0x88
#define LCD_SET_PWM_FRC 0x90
#define LCD_SET_POWER_SAVE 0xa8
#define LCD_REVERSE 0xa6
#define CS_LO and_l(~0x00000020, &GPIO1_OUT)
#define CS_HI or_l(0x00000020, &GPIO1_OUT)
#define CLK_LO and_l(~0x00004000, &GPIO_OUT)
#define CLK_HI or_l(0x00004000, &GPIO_OUT)
#define DATA_LO and_l(~0x00002000, &GPIO_OUT)
#define DATA_HI or_l(0x00002000, &GPIO_OUT)
#define RS_LO and_l(~0x00008000, &GPIO_OUT)
#define RS_HI or_l(0x00008000, &GPIO_OUT)
#define LCD_REMOTE_DEFAULT_CONTRAST 0x18;
/* cached settings values */
static bool cached_invert = false;
static bool cached_flip = false;
static int cached_contrast = LCD_REMOTE_DEFAULT_CONTRAST;
bool remote_initialized = false;
/* Standard low-level byte writer. Requires CLK high on entry */
static inline void _write_byte(unsigned data)
{
asm volatile (
"move.l (%[gpo0]), %%d0 \n" /* Get current state of data line */
"and.l %[dbit], %%d0 \n"
"beq.s 1f \n" /* and set it as previous-state bit */
"bset #8, %[data] \n"
"1: \n"
"move.l %[data], %%d0 \n" /* Compute the 'bit derivative', i.e. a value */
"lsr.l #1, %%d0 \n" /* with 1's where the data changes from the */
"eor.l %%d0, %[data] \n" /* previous state, and 0's where it doesn't */
"swap %[data] \n" /* Shift data to upper byte */
"lsl.l #8, %[data] \n"
"move.l %[cbit], %%d1 \n" /* Prepare mask for flipping CLK */
"or.l %[dbit], %%d1 \n" /* and DATA at once */
"lsl.l #1,%[data] \n" /* Shift out MSB */
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n" /* 1: Flip both CLK and DATA */
".word 0x51fa \n" /* (trapf.w - shadow next insn) */
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n" /* else flip CLK only */
"eor.l %[cbit], (%[gpo0]) \n" /* Flip CLK again */
"lsl.l #1,%[data] \n" /* ..unrolled.. */
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %%d1, (%[gpo0]) \n"
".word 0x51fa \n"
"1: \n"
"eor.l %[cbit], (%[gpo0]) \n"
"eor.l %[cbit], (%[gpo0]) \n"
: /* outputs */
[data]"+d"(data)
: /* inputs */
[gpo0]"a"(&GPIO_OUT),
[cbit]"d"(0x00004000),
[dbit]"d"(0x00002000)
: /* clobbers */
"d0", "d1"
);
}
/* Fast low-level byte writer. Don't use with high CPU clock.
* Requires CLK high on entry */
static inline void _write_fast(unsigned data)
{
asm volatile (
"move.w %%sr,%%d3 \n" /* Get current interrupt level */
"move.w #0x2700,%%sr \n" /* Disable interrupts */
"move.l (%[gpo0]), %%d0 \n" /* Get current state of data port */
"move.l %%d0, %%d1 \n"
"and.l %[dbit], %%d1 \n" /* Check current state of data line */
"beq.s 1f \n" /* and set it as previous-state bit */
"bset #8, %[data] \n"
"1: \n"
"move.l %[data], %%d1 \n" /* Compute the 'bit derivative', i.e. a value */
"lsr.l #1, %%d1 \n" /* with 1's where the data changes from the */
"eor.l %%d1, %[data] \n" /* previous state, and 0's where it doesn't */
"swap %[data] \n" /* Shift data to upper byte */
"lsl.l #8, %[data] \n"
"lsl.l #1,%[data] \n" /* Shift out MSB */
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n" /* 1: Flip data bit */
"1: \n"
"eor.l %[cbit], %%d0 \n" /* Flip clock bit */
"move.l %%d0, (%[gpo0]) \n" /* Output new state */
"eor.l %[cbit], %%d0 \n" /* Flip clock bit */
"move.l %%d0, (%[gpo0]) \n" /* Output new state */
"lsl.l #1,%[data] \n" /* ..unrolled.. */
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"lsl.l #1,%[data] \n"
"bcc.s 1f \n"
"eor.l %[dbit], %%d0 \n"
"1: \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"eor.l %[cbit], %%d0 \n"
"move.l %%d0, (%[gpo0]) \n"
"move.w %%d3, %%sr \n" /* Restore interrupt level */
: /* outputs */
[data]"+d"(data)
: /* inputs */
[gpo0]"a"(&GPIO_OUT),
[cbit]"d"(0x00004000),
[dbit]"d"(0x00002000)
: /* clobbers */
"d0", "d1", "d2", "d3"
);
}
void lcd_remote_write_command(int cmd)
{
RS_LO;
CS_LO;
_write_byte(cmd);
CS_HI;
}
void lcd_remote_write_command_ex(int cmd, int data)
{
RS_LO;
CS_LO;
_write_byte(cmd);
_write_byte(data);
CS_HI;
}
void lcd_remote_write_data(const unsigned char* p_bytes, int count)
{
const unsigned char *p_end = p_bytes + count;
RS_HI;
CS_LO;
if (cpu_frequency < 50000000)
{
while (p_bytes < p_end)
_write_fast(*p_bytes++);
}
else
{
while (p_bytes < p_end)
_write_byte(*p_bytes++);
}
CS_HI;
}
int lcd_remote_default_contrast(void)
{
return LCD_REMOTE_DEFAULT_CONTRAST;
}
void lcd_remote_powersave(bool on)
{
if(remote_initialized) {
if (on)
lcd_remote_write_command(LCD_SET_POWER_SAVE | 1);
else
lcd_remote_write_command(LCD_SET_POWER_SAVE | 1);
}
}
void lcd_remote_set_contrast(int val)
{
cached_contrast = val;
if(remote_initialized)
lcd_remote_write_command_ex(LCD_SET_VOLUME, val);
}
bool remote_detect(void)
{
return (GPIO_READ & 0x01000000)?false:true;
}
void lcd_remote_init_device(void)
{
or_l(0x0000e000, &GPIO_OUT);
or_l(0x0000e000, &GPIO_ENABLE);
or_l(0x0000e000, &GPIO_FUNCTION);
or_l(0x00000020, &GPIO1_OUT);
or_l(0x00000020, &GPIO1_ENABLE);
or_l(0x00000020, &GPIO1_FUNCTION);
and_l(~0x01000000, &GPIO_OUT);
and_l(~0x01000000, &GPIO_ENABLE);
or_l(0x01000000, &GPIO_FUNCTION);
}
void lcd_remote_on(void)
{
CS_HI;
CLK_HI;
sleep(10);
lcd_remote_write_command(LCD_SET_DUTY_RATIO);
lcd_remote_write_command(0x70); /* 1/128 */
lcd_remote_write_command(LCD_OSC_ON);
lcd_remote_write_command(LCD_SELECT_DCDC | 2); /* DC/DC 5xboost */
lcd_remote_write_command(LCD_SELECT_RES | 7); /* Regulator resistor: 7.2 */
lcd_remote_write_command(LCD_SET_BIAS | 6); /* 1/11 */
lcd_remote_write_command(LCD_CONTROL_POWER | 7); /* All circuits ON */
sleep(30);
lcd_remote_write_command_ex(LCD_SET_GRAY | 0, 0x00);
lcd_remote_write_command_ex(LCD_SET_GRAY | 1, 0x00);
lcd_remote_write_command_ex(LCD_SET_GRAY | 2, 0x0c);
lcd_remote_write_command_ex(LCD_SET_GRAY | 3, 0x00);
lcd_remote_write_command_ex(LCD_SET_GRAY | 4, 0xcc);
lcd_remote_write_command_ex(LCD_SET_GRAY | 5, 0x00);
lcd_remote_write_command_ex(LCD_SET_GRAY | 6, 0xcc);
lcd_remote_write_command_ex(LCD_SET_GRAY | 7, 0x0c);
lcd_remote_write_command(LCD_SET_PWM_FRC | 6); /* 4FRC + 12PWM */
lcd_remote_write_command(LCD_DISPLAY_ON | 1); /* display on */
remote_initialized = true;
lcd_remote_set_flip(cached_flip);
lcd_remote_set_contrast(cached_contrast);
lcd_remote_set_invert_display(cached_invert);
}
void lcd_remote_off(void)
{
remote_initialized = false;
CS_HI;
RS_HI;
}
/* Update the display.
This must be called after all other LCD functions that change the display. */
void lcd_remote_update(void) ICODE_ATTR;
void lcd_remote_update(void)
{
int y;
if(remote_initialized) {
for(y = 0;y < LCD_REMOTE_HEIGHT/8;y++) {
/* Copy display bitmap to hardware.
The COM48-COM63 lines are not connected so we have to skip
them. Further, the column address doesn't wrap, so we
have to update one page at a time. */
lcd_remote_write_command(LCD_SET_PAGE | (y>5?y+2:y));
lcd_remote_write_command_ex(LCD_SET_COLUMN | 0, 0);
lcd_remote_write_data((unsigned char *)lcd_remote_framebuffer[y],
LCD_REMOTE_WIDTH*2);
}
}
}
/* Update a fraction of the display. */
void lcd_remote_update_rect(int, int, int, int) ICODE_ATTR;
void lcd_remote_update_rect(int x, int y, int width, int height)
{
if(remote_initialized) {
int ymax;
/* The Y coordinates have to work on even 8 pixel rows */
ymax = (y + height-1) >> 3;
y >>= 3;
if(x + width > LCD_REMOTE_WIDTH)
width = LCD_REMOTE_WIDTH - x;
if (width <= 0)
return; /* nothing left to do, 0 is harmful to lcd_write_data() */
if(ymax >= LCD_REMOTE_HEIGHT)
ymax = LCD_REMOTE_HEIGHT-1;
/* Copy specified rectangle bitmap to hardware
COM48-COM63 are not connected, so we need to skip those */
for (; y <= ymax; y++)
{
lcd_remote_write_command(LCD_SET_PAGE |
((y > 5?y + 2:y) & 0xf));
lcd_remote_write_command_ex(LCD_SET_COLUMN | ((x >> 4) & 0xf),
x & 0xf);
lcd_remote_write_data (
(unsigned char *)&lcd_remote_framebuffer[y][x], width*2);
}
}
}
void lcd_remote_set_invert_display(bool yesno)
{
cached_invert = yesno;
if(remote_initialized)
lcd_remote_write_command(LCD_REVERSE | yesno);
}
void lcd_remote_set_flip(bool yesno)
{
cached_flip = yesno;
if(remote_initialized) {
if(yesno) {
lcd_remote_write_command(LCD_SELECT_ADC | 0);
lcd_remote_write_command(LCD_SELECT_SHL | 0);
lcd_remote_write_command_ex(LCD_SET_COM0, 16);
} else {
lcd_remote_write_command(LCD_SELECT_ADC | 1);
lcd_remote_write_command(LCD_SELECT_SHL | 8);
lcd_remote_write_command_ex(LCD_SET_COM0, 0);
}
}
}