---
c/src/lib/libbsp/arm/gba/console/conio.c | 176 ++++++++++++++++-------------
c/src/lib/libbsp/arm/gba/console/console.c | 75 ++++++------
2 files changed, 140 insertions(+), 111 deletions(-)
diff --git a/c/src/lib/libbsp/arm/gba/console/conio.c
b/c/src/lib/libbsp/arm/gba/console/conio.c
index 47cf6b4..1027b2a 100644
--- a/c/src/lib/libbsp/arm/gba/console/conio.c
+++ b/c/src/lib/libbsp/arm/gba/console/conio.c
@@ -3,6 +3,7 @@
*
* This file contains the GBA conio I/O package.
*/
+
/*
* RTEMS GBA BSP
*
@@ -118,21 +119,39 @@ void gba_gotoxy(int _x, int _y)
* @param y screen y coordinate
* @return None
*/
-void gba_putchar(char c, int textattr, int x, int y)
+static void gba_putchar(char c, int textattr, int x, int y)
{
- int f = textattr & 0x0F;
- int b = textattr >> 4;
- uint32_t fmask = f | f<<8 | f<<16 | f<<24;
- uint32_t bmask = b | b<<8 | b<<16 | b<<24;
- uint32_t *dest = (uint32_t *)&bg_bitmap4a[((y<<1) + y) << 1][x<<2];
- const uint32_t *src = (uint32_t *)&(font3x5[(int)c]);
- uint32_t s;
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
- s = *src++; *dest = (fmask&s) | (bmask&~s); dest +=
GBA_LCD_WIDTH/sizeof(uint32_t);
+ int f = textattr & 0x0F;
+ int b = textattr >> 4;
+ uint32_t fmask = f | f<<8 | f<<16 | f<<24;
+ uint32_t bmask = b | b<<8 | b<<16 | b<<24;
+ uint32_t *dest = (uint32_t *)&bg_bitmap4a[((y<<1) + y) << 1][x<<2];
+ const uint32_t *src = (uint32_t *)&(font3x5[(int)c]);
+ uint32_t s;
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
+
+ s = *src++;
+ *dest = (fmask&s) | (bmask&~s);
+ dest += GBA_LCD_WIDTH/sizeof(uint32_t);
}
@@ -144,7 +163,7 @@ void gba_putchar(char c, int textattr, int x, int y)
*/
void gba_textattr(int _attr)
{
- _textattr = _attr;
+ _textattr = _attr;
}
/**
@@ -152,11 +171,11 @@ void gba_textattr(int _attr)
*
* @param _color backround color
* @return None
-
+ *
*/
void gba_textbackground(int _color)
{
- _textattr = (_textattr & 0x0F) | (_color << 4);
+ _textattr = (_textattr & 0x0F) | (_color << 4);
}
/**
@@ -167,25 +186,25 @@ void gba_textbackground(int _color)
*/
void gba_textcolor(int _color)
{
- _textattr = (_textattr & 0xF0) | (_color);
+ _textattr = (_textattr & 0xF0) | (_color);
}
/**
- * @brief gba_clearline function clear line nro y
+ * @brief gba_clearline function clear line number y
*
* Line is filled with spaces
*
* @param y line number
* @return None
*/
-void gba_clearline(int y)
+static void gba_clearline(int y)
{
- int x;
+ int x;
- for (x=0 ; x<=W ; x++) {
- gba_putchar(0, _textattr, x, y);
- }
+ for (x=0 ; x<=W ; x++) {
+ gba_putchar(0, _textattr, x, y);
+ }
}
/**
@@ -194,7 +213,7 @@ void gba_clearline(int y)
* @param None
* @return None
*/
-void gba_nextline(void)
+static void gba_nextline(void)
{
_wherex = 0;
if (++_wherey >= H) {
@@ -226,7 +245,7 @@ void gba_clrscr(void)
* @param _c character code
* @return None
*/
-void gba_put(char _c)
+static void gba_put(char _c)
{
/* We have save some memory with reduced fonts */
_c = _c & 0x7F; /* no extened chars */
@@ -334,13 +353,12 @@ void gba_initconio(void)
*/
void gba_textmode(int _mode)
{
- switch (_mode) {
- case CO60:
- {
- gba_initconio();
- break;
- }
+ switch (_mode) {
+ case CO60: {
+ gba_initconio();
+ break;
}
+ }
}
@@ -350,17 +368,19 @@ void gba_textmode(int _mode)
* @param count loop counter
* @return None
*/
-void delay_loop(unsigned int count)
+static void delay_loop(unsigned int count)
{
- int i;
- for (i = 0; i<count; i++) i = i;
+ int i;
+
+ for (i = 0; i<count; i++) i = i;
}
static unsigned char inputch = ASCII_CR; /**< input character value */
/**
* @brief gba_getch function read char from game pad keys
*
- * Character input is done with GBA buttons,
up-down-left-right/A/B/R/L/Select/Start
+ * Character input is done with GBA buttons,
+ * up-down-left-right/A/B/R/L/Select/Start
* - Select-key accept selected character
* - Start-key read CR (Enter)
* - A-key select 'A' character
@@ -380,47 +400,47 @@ int gba_getch(void)
int keyx, key = 0;
while(1) {
- key = GBA_KEY();
- while ( (keyx=GBA_KEY())==key );
- switch (key)
- {
- case GBA_KEY_SELECT:
- gba_put(inputch);
- return inputch;
- break;
- case GBA_KEY_START:
- gba_put(' ');
- inputch = ASCII_CR;
- return inputch;
- break;
- case GBA_KEY_A:
- inputch = 'A';
- break;
- case GBA_KEY_B:
- inputch = 'Z';
- break;
- case GBA_KEY_UP:
- if ((inputch-1) >= 0x20) inputch--;
- break;
- case GBA_KEY_DOWN:
- if ((inputch+1) <= 0x7E) inputch++;
- break;
- case GBA_KEY_LEFT:
- if ((inputch - 0x20) >= 0x20) inputch -= 0x20;
- break;
- case GBA_KEY_RIGHT:
- if ((inputch + 0x20) <= 0x7E) inputch += 0x20;
- break;
- case GBA_KEY_R:
- inputch = '1';
- break;
- case GBA_KEY_L:
- inputch = '9';
- break;
- default:
- break;
- }
- gba_put(inputch);
- delay_loop(1000);
+ key = GBA_KEY();
+ while ( (keyx=GBA_KEY())==key );
+ switch (key) {
+ case GBA_KEY_SELECT:
+ gba_put(inputch);
+ return inputch;
+ break;
+ case GBA_KEY_START:
+ gba_put(' ');
+ inputch = ASCII_CR;
+ return inputch;
+ break;
+ case GBA_KEY_A:
+ inputch = 'A';
+ break;
+ case GBA_KEY_B:
+ inputch = 'Z';
+ break;
+ case GBA_KEY_UP:
+ if ((inputch-1) >= 0x20) inputch--;
+ break;
+ case GBA_KEY_DOWN:
+ if ((inputch+1) <= 0x7E) inputch++;
+ break;
+ case GBA_KEY_LEFT:
+ if ((inputch - 0x20) >= 0x20) inputch -= 0x20;
+ break;
+ case GBA_KEY_RIGHT:
+ if ((inputch + 0x20) <= 0x7E) inputch += 0x20;
+ break;
+ case GBA_KEY_R:
+ inputch = '1';
+ break;
+ case GBA_KEY_L:
+ inputch = '9';
+ break;
+ default:
+ break;
+ }
+
+ gba_put(inputch);
+ delay_loop(1000);
}
}
diff --git a/c/src/lib/libbsp/arm/gba/console/console.c
b/c/src/lib/libbsp/arm/gba/console/console.c
index 2647d59..35ec017 100644
--- a/c/src/lib/libbsp/arm/gba/console/console.c
+++ b/c/src/lib/libbsp/arm/gba/console/console.c
@@ -3,6 +3,7 @@
*
* This file contains the GBA console I/O package.
*/
+
/*
* RTEMS GBA BSP
*
@@ -34,7 +35,7 @@
*/
static int gba_pollRead(int minor)
{
- return(gba_getch());
+ return (gba_getch());
}
/**
@@ -52,7 +53,7 @@ static ssize_t gba_write(int minor, const char *buf, size_t
len)
int i;
for (i=0;i<len;i++) {
- gba_putch((unsigned short)buf[i]);
+ gba_putch((unsigned short)buf[i]);
}
return len;
}
@@ -85,9 +86,11 @@ BSP_polling_getchar_function_type BSP_poll_char =
gba_getch;
* @return status code
*/
rtems_device_driver
-console_initialize(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg)
+console_initialize(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
{
rtems_status_code status;
@@ -95,13 +98,13 @@ console_initialize(rtems_device_major_number major,
rtems_termios_initialize ();
/* Do device-specific initialization */
- /* Allready done in bspstart.c -> gba_textmode(CO60); */
+ /* Already done in bspstart.c -> gba_textmode(CO60); */
/* Register the device */
status = rtems_io_register_name ("/dev/console", major, 0);
if (status != RTEMS_SUCCESSFUL) {
- printk("Error registering console device!\n");
- rtems_fatal_error_occurred (status);
+ printk("Error registering console device!\n");
+ rtems_fatal_error_occurred (status);
}
printk("Initialized GBA console\n\n");
@@ -119,7 +122,7 @@ console_initialize(rtems_device_major_number major,
*/
static int console_first_open(int major, int minor, void *arg)
{
- return 0;
+ return 0;
}
/**
@@ -132,10 +135,9 @@ static int console_first_open(int major, int minor, void
*arg)
*/
static int console_last_close(int major, int minor, void *arg)
{
- return 0;
+ return 0;
}
-
/**
* @brief Console device driver OPEN entry point
*
@@ -145,9 +147,11 @@ static int console_last_close(int major, int minor, void
*arg)
* @return status code
*/
rtems_device_driver
-console_open(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg)
+console_open(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
{
rtems_status_code status;
static rtems_termios_callbacks cb =
@@ -165,8 +169,8 @@ console_open(rtems_device_major_number major,
status = rtems_termios_open (major, minor, arg, &cb);
if (status != RTEMS_SUCCESSFUL) {
- printk("Error openning console device\n");
- return status;
+ printk("Error openning console device\n");
+ return status;
}
return RTEMS_SUCCESSFUL;
@@ -181,9 +185,11 @@ console_open(rtems_device_major_number major,
* @return status code
*/
rtems_device_driver
-console_close(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg)
+console_close(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
{
rtems_device_driver res = RTEMS_SUCCESSFUL;
@@ -203,13 +209,13 @@ console_close(rtems_device_major_number major,
* @return status code
*/
rtems_device_driver
-console_read(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg)
+console_read(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
{
-
- return rtems_termios_read (arg);
-
+ return rtems_termios_read (arg);
}
/**
@@ -223,11 +229,13 @@ console_read(rtems_device_major_number major,
* @return status code
*/
rtems_device_driver
-console_write(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg)
+console_write(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
{
- return rtems_termios_write (arg);
+ return rtems_termios_write (arg);
}
/**
@@ -239,10 +247,11 @@ console_write(rtems_device_major_number major,
* @return status code
*/
rtems_device_driver
-console_control(rtems_device_major_number major,
- rtems_device_minor_number minor,
- void *arg
+console_control(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
)
{
- return rtems_termios_ioctl (arg);
+ return rtems_termios_ioctl (arg);
}
--
1.9.3
_______________________________________________
devel mailing list
devel@rtems.org
http://lists.rtems.org/mailman/listinfo/devel
