QEMU i486: New QEMU keyboard and VGA drivers from Lizhuoyi
This commit is contained in:
Gregory Nutt
parent
7e257ee7f4
commit
6dd1217bf9
@ -6949,3 +6949,7 @@
|
||||
* configs/pic32-starterkit, pic32mx7mmb, stm3210e-eval, stm3220g-eval,
|
||||
and stm3240g-eval: Refresh all configurations with the latest
|
||||
Kconfig files (2014-3-7).
|
||||
* configs/qemu-i486/src: Files renamed to correspond with current
|
||||
thinking about naming (2014-3-8).
|
||||
* arch/x86/src/qemu/qemu_keypad.c and qemu_vga.c: New QEMU keyboard
|
||||
and VGA drivers from Lizhuoyi (2014-3-8).
|
||||
|
||||
@ -6,4 +6,17 @@
|
||||
if ARCH_CHIP_QEMU
|
||||
comment "QEMU Configuration Options"
|
||||
|
||||
config QEMU_KEYPAD
|
||||
bool "QEMU Keypad"
|
||||
default n
|
||||
---help---
|
||||
Enable support for the QEMU keypad. See qemu_keypad.h for
|
||||
interfaces.
|
||||
|
||||
config QEMU_VGA
|
||||
bool "QEMU VGA"
|
||||
default n
|
||||
---help---
|
||||
Enable support for the QEMU VGA. See qemu_vga.h for interfaces.
|
||||
|
||||
endif
|
||||
|
||||
@ -1,7 +1,7 @@
|
||||
############################################################################
|
||||
# arch/x86/src/qemu/Make.defs
|
||||
#
|
||||
# Copyright (C) 2011 Gregory Nutt. All rights reserved.
|
||||
# Copyright (C) 2011, 2014 Gregory Nutt. All rights reserved.
|
||||
# Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
#
|
||||
# Redistribution and use in source and binary forms, with or without
|
||||
@ -40,18 +40,27 @@ HEAD_ASRC = qemu_head.S
|
||||
# Common x86 and i486 files
|
||||
|
||||
CMN_ASRCS = i486_utils.S up_syscall6.S
|
||||
CMN_CSRCS = up_allocateheap.c up_assert.c up_blocktask.c up_copystate.c \
|
||||
up_createstack.c up_mdelay.c up_udelay.c up_exit.c\
|
||||
up_initialize.c up_initialstate.c up_interruptcontext.c up_irq.c \
|
||||
up_modifyreg8.c up_modifyreg16.c up_modifyreg32.c up_regdump.c \
|
||||
up_releasepending.c up_releasestack.c up_reprioritizertr.c \
|
||||
up_savestate.c up_sigdeliver.c up_schedulesigaction.c up_unblocktask.c \
|
||||
up_usestack.c
|
||||
CMN_CSRCS += up_allocateheap.c up_assert.c up_blocktask.c up_copystate.c
|
||||
CMN_CSRCS += up_createstack.c up_mdelay.c up_udelay.c up_exit.c
|
||||
CMN_CSRCS += up_initialize.c up_initialstate.c up_interruptcontext.c
|
||||
CMN_CSRCS += up_irq.c up_modifyreg8.c up_modifyreg16.c up_modifyreg32.c
|
||||
CMN_CSRCS += up_regdump.c up_releasepending.c up_releasestack.c
|
||||
CMN_CSRCS += up_reprioritizertr.c up_savestate.c up_sigdeliver.c
|
||||
CMN_CSRCS += up_schedulesigaction.c up_unblocktask.c up_usestack.c
|
||||
|
||||
# Required QEMU files
|
||||
|
||||
CHIP_ASRCS = qemu_saveusercontext.S qemu_fullcontextrestore.S qemu_vectors.S
|
||||
CHIP_CSRCS = qemu_handlers.c qemu_idle.c qemu_lowputc.c qemu_lowsetup.c \
|
||||
qemu_serial.c qemu_timerisr.c
|
||||
CHIP_CSRCS = qemu_handlers.c qemu_idle.c qemu_lowputc.c qemu_lowsetup.c
|
||||
CHIP_CSRCS += qemu_serial.c qemu_timerisr.c
|
||||
|
||||
# Configuration-dependent QEMU files
|
||||
|
||||
ifeq ($(CONFIG_QEMU_KEYPAD),y)
|
||||
CHIP_CSRCS += qemu_keypad.c
|
||||
endif
|
||||
|
||||
ifeq ($(CONFIG_QEMU_VGA),y)
|
||||
CHIP_CSRCS += qemu_vga.c
|
||||
endif
|
||||
|
||||
|
||||
322
arch/x86/src/qemu/qemu_keypad.c
Normal file
322
arch/x86/src/qemu/qemu_keypad.c
Normal file
@ -0,0 +1,322 @@
|
||||
/****************************************************************************
|
||||
* arch/x86/src/qemu_keypad.c
|
||||
*
|
||||
* Copyright (C) 2013 Li Zhuoyi. All rights reserved.
|
||||
* Author: Li Zhuoyi <lzyy.cn@gmail.com>
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* 3. Neither the name NuttX nor the names of its contributors may be
|
||||
* used to endorse or promote products derived from this software
|
||||
* without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
* POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
|
||||
#include <nuttx/arch.h>
|
||||
#include <nuttx/irq.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include <stdint.h>
|
||||
#include <semaphore.h>
|
||||
#include <errno.h>
|
||||
#include <unistd.h>
|
||||
#include <sched.h>
|
||||
|
||||
#include <arch/io.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
typedef enum
|
||||
{
|
||||
/* The keyboard syms have been cleverly chosen to map to ASCII */
|
||||
|
||||
KEY_UNKNOWN = 0,
|
||||
KEY_NOKEY = 0,
|
||||
KEY_FIRST = 0,
|
||||
KEY_BACKSPACE = 8,
|
||||
KEY_TAB = 9,
|
||||
KEY_CLEAR = 12,
|
||||
KEY_RETURN = 13,
|
||||
KEY_PAUSE = 19,
|
||||
KEY_ESCAPE = 27,
|
||||
|
||||
KEY_SPACE = 32,
|
||||
KEY_EXCLAIM = 33,
|
||||
KEY_QUOTEDBL = 34,
|
||||
KEY_HASH = 35,
|
||||
KEY_DOLLAR = 36,
|
||||
KEY_AMPERSAND = 38,
|
||||
KEY_QUOTE = 39,
|
||||
KEY_LEFTPAREN = 40,
|
||||
KEY_RIGHTPAREN = 41,
|
||||
KEY_ASTERISK = 42,
|
||||
KEY_PLUS = 43,
|
||||
KEY_COMMA = 44,
|
||||
KEY_MINUS = 45,
|
||||
KEY_PERIOD = 46,
|
||||
KEY_SLASH = 47,
|
||||
KEY_0 = 48,
|
||||
KEY_1 = 49,
|
||||
KEY_2 = 50,
|
||||
KEY_3 = 51,
|
||||
KEY_4 = 52,
|
||||
KEY_5 = 53,
|
||||
KEY_6 = 54,
|
||||
KEY_7 = 55,
|
||||
KEY_8 = 56,
|
||||
KEY_9 = 57,
|
||||
|
||||
KEY_COLON = 58,
|
||||
KEY_SEMICOLON = 59,
|
||||
KEY_LESS = 60,
|
||||
KEY_EQUALS = 61,
|
||||
KEY_GREATER = 62,
|
||||
KEY_QUESTION = 63,
|
||||
KEY_AT = 64,
|
||||
|
||||
KEY_LEFTBRACKET = 91,
|
||||
KEY_BACKSLASH = 92,
|
||||
KEY_RIGHTBRACKET = 93,
|
||||
KEY_CARET = 94,
|
||||
KEY_UNDERSCORE = 95,
|
||||
KEY_BACKQUOTE = 96,
|
||||
KEY_a = 97,
|
||||
KEY_b = 98,
|
||||
KEY_c = 99,
|
||||
KEY_d = 100,
|
||||
KEY_e = 101,
|
||||
KEY_f = 102,
|
||||
KEY_g = 103,
|
||||
KEY_h = 104,
|
||||
KEY_i = 105,
|
||||
KEY_j = 106,
|
||||
KEY_k = 107,
|
||||
KEY_l = 108,
|
||||
KEY_m = 109,
|
||||
KEY_n = 110,
|
||||
KEY_o = 111,
|
||||
KEY_p = 112,
|
||||
KEY_q = 113,
|
||||
KEY_r = 114,
|
||||
KEY_s = 115,
|
||||
KEY_t = 116,
|
||||
KEY_u = 117,
|
||||
KEY_v = 118,
|
||||
KEY_w = 119,
|
||||
KEY_x = 120,
|
||||
KEY_y = 121,
|
||||
KEY_z = 122,
|
||||
KEY_DELETE = 127,
|
||||
KEY_DEBUG = 138, /* 0x80+0x0a */
|
||||
|
||||
/* Arrows + Home/End pad */
|
||||
|
||||
KEY_S100 = 173,
|
||||
KEY_UP = 173,
|
||||
KEY_DOWN = 174,
|
||||
KEY_RIGHT = 175,
|
||||
KEY_LEFT = 176,
|
||||
KEY_INSERT = 177,
|
||||
KEY_HOME = 178,
|
||||
KEY_END = 179,
|
||||
KEY_PAGEUP = 180,
|
||||
KEY_PAGEDOWN = 181,
|
||||
|
||||
/* Function keys */
|
||||
|
||||
KEY_F1 = 182,
|
||||
KEY_F2 = 183,
|
||||
KEY_F3 = 184,
|
||||
KEY_F4 = 185,
|
||||
KEY_F5 = 186,
|
||||
KEY_F6 = 187,
|
||||
KEY_F7 = 188,
|
||||
KEY_F8 = 189,
|
||||
KEY_F9 = 190,
|
||||
KEY_F10 = 191,
|
||||
KEY_F11 = 192,
|
||||
KEY_F12 = 193,
|
||||
KEY_F13 = 194,
|
||||
KEY_F14 = 195,
|
||||
KEY_F15 = 196,
|
||||
|
||||
/* Key state modifier keys */
|
||||
|
||||
KEY_NUMLOCK = 200,
|
||||
KEY_CAPSLOCK = 201,
|
||||
KEY_SCROLLOCK = 202,
|
||||
KEY_RSHIFT = 203,
|
||||
KEY_LSHIFT = 204,
|
||||
KEY_RCTRL = 205,
|
||||
KEY_LCTRL = 206,
|
||||
KEY_RALT = 207,
|
||||
KEY_LALT = 208,
|
||||
KEY_RMETA = 209,
|
||||
KEY_LMETA = 210,
|
||||
KEY_LSUPER = 211, /* Left "Windows" key */
|
||||
KEY_RSUPER = 212, /* Right "Windows" key */
|
||||
KEY_MODE = 213, /* "Alt Gr" key */
|
||||
KEY_COMPOSE = 214, /* Multi-key compose key */
|
||||
|
||||
/* Miscellaneous function keys */
|
||||
|
||||
KEY_HELP = 215,
|
||||
KEY_PRINT = 216,
|
||||
KEY_SYSREQ = 217,
|
||||
KEY_BREAK = 218,
|
||||
KEY_QUIT = 250,
|
||||
|
||||
/* Add any other keys here */
|
||||
|
||||
KEY_LAST
|
||||
} MDKKey;
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
static int keypad_open(struct file *filep);
|
||||
static int keypad_close(struct file *filep);
|
||||
static ssize_t keypad_read(struct file *filep, FAR char *buf, size_t buflen);
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
static const unsigned char g_kdbus[128] =
|
||||
{
|
||||
0, KEY_QUIT, '1', '2', '3', '4', '5', '6', '7', '8', /* 9 */
|
||||
'9', '0', '-', '=', '\b', /* Backspace */
|
||||
'\t', /* Tab */
|
||||
'q', 'w', 'e', 'r', /* 19 */
|
||||
't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n', /* Enter key */
|
||||
0, /* 29 - Control */
|
||||
'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', /* 39 */
|
||||
'\'', '`', 0, /* Left shift */
|
||||
'\\', 'z', 'x', 'c', 'v', 'b', 'n', /* 49 */
|
||||
'm', ',', '.', '/', 0, /* Right shift */
|
||||
'*',
|
||||
0, /* Alt */
|
||||
' ', /* Space bar */
|
||||
0, /* Caps lock */
|
||||
KEY_F1, /* 59 - F1 key ... > */
|
||||
KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6, KEY_F7, KEY_F8, KEY_F9,
|
||||
KEY_F10, /* < ... F10 */
|
||||
0, /* 69 - Num lock*/
|
||||
0, /* Scroll Lock */
|
||||
KEY_HOME, /* Home key */
|
||||
KEY_UP, /* Up Arrow */
|
||||
KEY_PAGEUP, /* Page Up */
|
||||
'-',
|
||||
KEY_LEFT, /* Left Arrow */
|
||||
0,
|
||||
KEY_RIGHT, /* Right Arrow */
|
||||
'+',
|
||||
KEY_END, /* 79 - End key*/
|
||||
KEY_DOWN, /* Down Arrow */
|
||||
KEY_PAGEDOWN, /* Page Down */
|
||||
KEY_INSERT, /* Insert Key */
|
||||
KEY_DELETE, /* Delete Key */
|
||||
0, 0, 0,
|
||||
0, /* F11 Key */
|
||||
0, /* F12 Key */
|
||||
0, /* All other keys are undefined */
|
||||
};
|
||||
|
||||
static const struct file_operations g_keypadops =
|
||||
{
|
||||
keypad_open, /* open */
|
||||
keypad_close, /* close */
|
||||
keypad_read, /* read */
|
||||
0, /* write */
|
||||
0, /* seek */
|
||||
0, /* ioctl */
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
static int keypad_open(struct file *filep)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int keypad_close(struct file *filep)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
|
||||
static ssize_t keypad_read(struct file *filep, FAR char *buf, size_t buflen)
|
||||
{
|
||||
uint_fast8_t keycode = 0;
|
||||
uint_fast8_t scancode = 0;
|
||||
uint_fast8_t keyflags;
|
||||
|
||||
if (buf == NULL || buflen < 1)
|
||||
{
|
||||
/* Well... nothing to do */
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
keyflags = inb(0x64);
|
||||
if (keyflags & 0x01)
|
||||
{
|
||||
scancode = inb(0x60);
|
||||
if ((scancode & 0x80) == 0)
|
||||
{
|
||||
keycode = g_kdbus[scancode];
|
||||
//printf("%02x ",scancode);
|
||||
buf[0] = keycode;
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
/****************************************************************************
|
||||
* Name: qemu_keypad
|
||||
*
|
||||
* Description:
|
||||
* Registers the QEMU keypad driver
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
void qemu_keypad(void)
|
||||
{
|
||||
(void)register_driver("/dev/keypad", &g_keypadops, 0444, NULL);
|
||||
}
|
||||
514
arch/x86/src/qemu/qemu_vga.c
Normal file
514
arch/x86/src/qemu/qemu_vga.c
Normal file
@ -0,0 +1,514 @@
|
||||
/****************************************************************************
|
||||
* drivers/lcd/vga.c
|
||||
*
|
||||
* Copyright (C) 2011 Li Zhuoyi. All rights reserved.
|
||||
* Author: Li Zhuoyi <lzyy.cn@gmail.com>
|
||||
* History: 0.1 2012-11-30 initial version
|
||||
*
|
||||
* Derived from drivers/lcd/skeleton.c
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* 3. Neither the name NuttX nor the names of its contributors may be
|
||||
* used to endorse or promote products derived from this software
|
||||
* without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
* POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
|
||||
#include <sys/types.h>
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/arch.h>
|
||||
#include <nuttx/lcd/lcd.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include <arch/io.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
#define R_COM 0x63 /* "common" bits */
|
||||
|
||||
#define R_W256 0x00
|
||||
#define R_W320 0x00
|
||||
#define R_W360 0x04
|
||||
#define R_W376 0x04
|
||||
#define R_W400 0x04
|
||||
|
||||
#define R_H200 0x00
|
||||
#define R_H224 0x80
|
||||
#define R_H240 0x80
|
||||
#define R_H256 0x80
|
||||
#define R_H270 0x80
|
||||
#define R_H300 0x80
|
||||
#define R_H360 0x00
|
||||
#define R_H400 0x00
|
||||
#define R_H480 0x80
|
||||
#define R_H564 0x80
|
||||
#define R_H600 0x80
|
||||
|
||||
#define SZ(x) (sizeof(x)/sizeof(x[0]))
|
||||
|
||||
#define VGA_XRES 320
|
||||
#define VGA_YRES 240
|
||||
#define VGA_BPP 8
|
||||
#define VGA_FBSIZE (VGA_XRES * VGA_YRES * VGA_BPP / 8)
|
||||
#define VGA_COLORFMT FB_FMT_RGB8
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
static int init_graph_vga(int width, int height,int chain4);
|
||||
static int vga_putrun(fb_coord_t row, fb_coord_t col, FAR const uint8_t *buffer,
|
||||
size_t npixels);
|
||||
static int vga_getrun(fb_coord_t row, fb_coord_t col, FAR uint8_t *buffer,
|
||||
size_t npixels);
|
||||
static int vga_getvideoinfo(FAR struct lcd_dev_s *dev,
|
||||
FAR struct fb_videoinfo_s *vinfo);
|
||||
static int vga_getplaneinfo(FAR struct lcd_dev_s *dev, unsigned int planeno,
|
||||
FAR struct lcd_planeinfo_s *pinfo);
|
||||
static int vga_getpower(struct lcd_dev_s *dev);
|
||||
static int vga_setpower(struct lcd_dev_s *dev, int power);
|
||||
static int vga_getcontrast(struct lcd_dev_s *dev);
|
||||
static int vga_setcontrast(struct lcd_dev_s *dev, unsigned int contrast);
|
||||
static int vga_open(struct file *filep);
|
||||
static int vga_close(struct file *filep);
|
||||
static ssize_t vga_read(struct file *filep, FAR char *buf, size_t buflen);
|
||||
static ssize_t vga_write(struct file *filep, FAR const char *buf, size_t buflen);
|
||||
static off_t vga_seek(FAR struct file *filp, off_t offset, int whence);
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
static const uint8_t g_hor_regs[] = { 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x13 };
|
||||
|
||||
static const uint8_t g_width_256[] = { 0x5f, 0x3f, 0x40, 0x82, 0x4a,0x9a, 0x20 };
|
||||
static const uint8_t g_width_320[] = { 0x5f, 0x4f, 0x50, 0x82, 0x54,0x80, 0x28 };
|
||||
static const uint8_t g_width_360[] = { 0x6b, 0x59, 0x5a, 0x8e, 0x5e,0x8a, 0x2d };
|
||||
static const uint8_t g_width_376[] = { 0x6e, 0x5d, 0x5e, 0x91, 0x62,0x8f, 0x2f };
|
||||
static const uint8_t g_width_400[] = { 0x70, 0x63, 0x64, 0x92, 0x65,0x82, 0x32 };
|
||||
|
||||
static const uint8_t g_ver_regs[] = { 0x6, 0x7, 0x9, 0x10, 0x11,0x12, 0x15, 0x16 };
|
||||
|
||||
static const uint8_t height_200[] = { 0xbf, 0x1f, 0x41, 0x9c, 0x8e,0x8f, 0x96, 0xb9 };
|
||||
static const uint8_t height_224[] = { 0x0b, 0x3e, 0x41, 0xda, 0x9c,0xbf, 0xc7, 0x04 };
|
||||
static const uint8_t height_240[] = { 0x0d, 0x3e, 0x41, 0xea, 0xac,0xdf, 0xe7, 0x06 };
|
||||
static const uint8_t height_256[] = { 0x23, 0xb2, 0x61, 0x0a, 0xac,0xff, 0x07, 0x1a };
|
||||
static const uint8_t height_270[] = { 0x30, 0xf0, 0x61, 0x20, 0xa9,0x1b, 0x1f, 0x2f };
|
||||
static const uint8_t height_300[] = { 0x70, 0xf0, 0x61, 0x5b, 0x8c,0x57, 0x58, 0x70 };
|
||||
static const uint8_t height_360[] = { 0xbf, 0x1f, 0x40, 0x88, 0x85,0x67, 0x6d, 0xba };
|
||||
static const uint8_t height_400[] = { 0xbf, 0x1f, 0x40, 0x9c, 0x8e,0x8f, 0x96, 0xb9 };
|
||||
static const uint8_t height_480[] = { 0x0d, 0x3e, 0x40, 0xea, 0xac,0xdf, 0xe7, 0x06 };
|
||||
static const uint8_t height_564[] = { 0x62, 0xf0, 0x60, 0x37, 0x89,0x33, 0x3c, 0x5c };
|
||||
static const uint8_t height_600[] = { 0x70, 0xf0, 0x60, 0x5b, 0x8c,0x57, 0x58, 0x70 };
|
||||
|
||||
static const uint8_t g_bg_color = 0x0f;
|
||||
static const uint8_t g_fg_color = 0x01;
|
||||
|
||||
static uint8_t g_runbuffer[VGA_XRES];
|
||||
static uint8_t *g_pscreen = (uint8_t*)(0xa0000);
|
||||
|
||||
static off_t g_curpos;
|
||||
|
||||
/* This is the standard, NuttX LCD driver object */
|
||||
|
||||
static struct lcd_dev_s g_lcddev =
|
||||
{
|
||||
.getvideoinfo = vga_getvideoinfo,
|
||||
.getplaneinfo = vga_getplaneinfo,
|
||||
|
||||
.getpower = vga_getpower,
|
||||
.setpower = vga_setpower,
|
||||
.getcontrast = vga_getcontrast,
|
||||
.setcontrast = vga_setcontrast,
|
||||
};
|
||||
|
||||
static const struct file_operations g_vgaops =
|
||||
{
|
||||
vga_open, /* open */
|
||||
vga_close, /* close */
|
||||
vga_read, /* read */
|
||||
vga_write, /* write */
|
||||
vga_seek, /* seek */
|
||||
0, /* ioctl */
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/* The chain4 parameter should be 1 for normal 13h-type mode, but
|
||||
* only allows 320x200 256x200, 256x240 and 256x256 because you
|
||||
* can only access the first 64kb
|
||||
*
|
||||
* If chain4 is 0, then plane mode is used (tweaked modes), and
|
||||
* you'll need to switch planes to access the whole screen but
|
||||
* that allows you using any resolution, up to 400x600
|
||||
*
|
||||
* Returns 0=ok, -n=fail
|
||||
*/
|
||||
|
||||
static int init_graph_vga(int width, int height,int chain4)
|
||||
{
|
||||
const uint8_t *w;
|
||||
const uint8_t *h;
|
||||
uint8_t val;
|
||||
int a;
|
||||
|
||||
switch (width)
|
||||
{
|
||||
case 256:
|
||||
w = g_width_256;
|
||||
val = R_COM + R_W256;
|
||||
break;
|
||||
|
||||
case 320:
|
||||
w = g_width_320;
|
||||
val = R_COM + R_W320;
|
||||
break;
|
||||
|
||||
case 360:
|
||||
w = g_width_360;
|
||||
val = R_COM + R_W360;
|
||||
break;
|
||||
|
||||
case 376:
|
||||
w = g_width_376;
|
||||
val = R_COM + R_W376;
|
||||
break;
|
||||
|
||||
case 400:
|
||||
w = g_width_400;
|
||||
val = R_COM + R_W400;
|
||||
break;
|
||||
|
||||
default:
|
||||
return -1; /* fail */
|
||||
}
|
||||
|
||||
switch (height)
|
||||
{
|
||||
case 200:
|
||||
h = height_200;
|
||||
val |= R_H200;
|
||||
break;
|
||||
|
||||
case 224:
|
||||
h = height_224;
|
||||
val |= R_H224;
|
||||
break;
|
||||
|
||||
case 240:
|
||||
h = height_240;
|
||||
val |= R_H240;
|
||||
break;
|
||||
|
||||
case 256:
|
||||
h = height_256;
|
||||
val |= R_H256;
|
||||
break;
|
||||
|
||||
case 270:
|
||||
h = height_270;
|
||||
val |= R_H270;
|
||||
break;
|
||||
|
||||
case 300:
|
||||
h = height_300;
|
||||
val |= R_H300;
|
||||
break;
|
||||
|
||||
case 360:
|
||||
h = height_360;
|
||||
val |= R_H360;
|
||||
break;
|
||||
|
||||
case 400:
|
||||
h = height_400;
|
||||
val |= R_H400;
|
||||
break;
|
||||
|
||||
case 480:
|
||||
h = height_480;
|
||||
val |= R_H480;
|
||||
break;
|
||||
|
||||
case 564:
|
||||
h = height_564;
|
||||
val |= R_H564;
|
||||
break;
|
||||
|
||||
case 600:
|
||||
h = height_600;
|
||||
val |= R_H600;
|
||||
break;
|
||||
|
||||
default:
|
||||
return -2; /* fail */
|
||||
}
|
||||
|
||||
/* chain4 not available if mode takes over 64k */
|
||||
|
||||
/* if(chain4 && (long)width*(long)height>65536L) return -3; */
|
||||
|
||||
/* here goes the actual modeswitch */
|
||||
|
||||
outb(val, 0x3c2);
|
||||
outw(0x0e11, 0x3d4); /* enable regs 0-7 */
|
||||
|
||||
for(a = 0; a < SZ(g_hor_regs); ++a)
|
||||
{
|
||||
outw((uint16_t)((w[a] << 8) + g_hor_regs[a]), 0x3d4);
|
||||
}
|
||||
|
||||
for(a = 0; a < SZ(g_ver_regs); ++a)
|
||||
{
|
||||
outw((uint16_t)((h[a] << 8) + g_ver_regs[a]), 0x3d4);
|
||||
}
|
||||
|
||||
outw(0x0008, 0x3d4); /* vert.panning = 0 */
|
||||
|
||||
if(chain4)
|
||||
{
|
||||
outw(0x4014, 0x3d4);
|
||||
outw(0xa317, 0x3d4);
|
||||
outw(0x0e04, 0x3c4);
|
||||
}
|
||||
else
|
||||
{
|
||||
outw(0x0014, 0x3d4);
|
||||
outw(0xe317, 0x3d4);
|
||||
outw(0x0604, 0x3c4);
|
||||
}
|
||||
|
||||
outw(0x0101, 0x3c4);
|
||||
outw(0x0f02, 0x3c4); /* Enable writing to all planes */
|
||||
outw(0x4005, 0x3ce); /* 256 color mode */
|
||||
outw(0x0106, 0x3ce); /* Extend graph mode & a000-bfff */
|
||||
|
||||
inb(0x3da);
|
||||
outb(0x30, 0x3c0);
|
||||
outb(0x41, 0x3c0);
|
||||
outb(0x33, 0x3c0);
|
||||
outb(0x00, 0x3c0);
|
||||
|
||||
for(a = 0; a < 16; a++) /* ega pal */
|
||||
{
|
||||
outb((uint8_t)a, 0x3c0);
|
||||
outb((uint8_t)a, 0x3c0);
|
||||
}
|
||||
|
||||
outb( 0x20, 0x3c0); /* enable video */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int vga_putrun(fb_coord_t row, fb_coord_t col, FAR const uint8_t *buffer,
|
||||
size_t npixels)
|
||||
{
|
||||
memcpy(&g_pscreen[row*VGA_XRES + col],buffer, npixels);
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_getrun(fb_coord_t row, fb_coord_t col, FAR uint8_t *buffer,
|
||||
size_t npixels)
|
||||
{
|
||||
memcpy(buffer,&g_pscreen[row*VGA_XRES + col],npixels);
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_getvideoinfo(FAR struct lcd_dev_s *dev,
|
||||
FAR struct fb_videoinfo_s *vinfo)
|
||||
{
|
||||
vinfo->fmt = VGA_COLORFMT;
|
||||
vinfo->xres = VGA_XRES; /* Horizontal resolution in pixel columns */
|
||||
vinfo->yres = VGA_YRES; /* Vertical resolution in pixel rows */
|
||||
vinfo->nplanes = 1; /* Number of color planes supported */
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_getplaneinfo(FAR struct lcd_dev_s *dev, unsigned int planeno,
|
||||
FAR struct lcd_planeinfo_s *pinfo)
|
||||
{
|
||||
pinfo->putrun = vga_putrun; /* Put a run into LCD memory */
|
||||
pinfo->getrun = vga_getrun; /* Get a run from LCD memory */
|
||||
pinfo->buffer = g_runbuffer; /* Run scratch buffer */
|
||||
pinfo->bpp = VGA_BPP; /* Bits-per-pixel */
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_getpower(struct lcd_dev_s *dev)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int vga_setpower(struct lcd_dev_s *dev, int power)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_getcontrast(struct lcd_dev_s *dev)
|
||||
{
|
||||
return -ENOSYS;
|
||||
}
|
||||
|
||||
static int vga_setcontrast(struct lcd_dev_s *dev, unsigned int contrast)
|
||||
{
|
||||
return -ENOSYS;
|
||||
}
|
||||
|
||||
static int vga_open(struct file * filep)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
|
||||
static int vga_close(struct file * filep)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
|
||||
static ssize_t vga_read(struct file *filep, FAR char *buf, size_t buflen)
|
||||
{
|
||||
if (buf == NULL || buflen < 1)
|
||||
{
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* memcpy(&buf,&g_pscreen[y*VGA_XRES + x],buflen); */
|
||||
return buflen;
|
||||
}
|
||||
|
||||
static ssize_t vga_write(struct file *filep, FAR const char *buf, size_t buflen)
|
||||
{
|
||||
int i;
|
||||
int j;
|
||||
|
||||
if (buf == NULL || buflen < 1)
|
||||
{
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
for (j = 0; j < buflen && g_curpos < VGA_FBSIZE; j++)
|
||||
{
|
||||
uint8_t dots = buf[j];
|
||||
for (i = 0; i < 8 && g_curpos < VGA_FBSIZE; i++)
|
||||
{
|
||||
g_pscreen[g_curpos++] = dots & 0x80 ? g_fg_color : g_bg_color;
|
||||
dots <<= 1;
|
||||
}
|
||||
}
|
||||
|
||||
return buflen;
|
||||
}
|
||||
|
||||
static off_t vga_seek(FAR struct file *filp, off_t offset, int whence)
|
||||
{
|
||||
ssize_t newpos;
|
||||
|
||||
/* Adjust the cursor position as requested */
|
||||
|
||||
switch (whence)
|
||||
{
|
||||
case SEEK_SET: /* From the start of the file */
|
||||
newpos = (ssize_t)offset;
|
||||
break;
|
||||
|
||||
case SEEK_CUR: /* From the current file offset */
|
||||
newpos = g_curpos + offset;
|
||||
break;
|
||||
|
||||
case SEEK_END: /* From the end of the file */
|
||||
newpos = (VGA_FBSIZE - 1) - offset;
|
||||
break;
|
||||
}
|
||||
|
||||
/* Make sure that the new cursor position lies within the frame buffer */
|
||||
|
||||
if (newpos < 0)
|
||||
{
|
||||
newpos = 0;
|
||||
}
|
||||
else if (newpos > VGA_FBSIZE)
|
||||
{
|
||||
newpos = VGA_FBSIZE;
|
||||
}
|
||||
|
||||
/* Set the new cursor position */
|
||||
|
||||
g_curpos = (off_t)newpos;
|
||||
return g_curpos;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: qemu_vga_initialize
|
||||
*
|
||||
* Description:
|
||||
* Initialize the QEMU VGA video hardware.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
FAR struct lcd_dev_s *qemu_vga_initialize(void)
|
||||
{
|
||||
int ret = init_graph_vga(VGA_XRES, VGA_YRES, 1);
|
||||
if (ret < 0)
|
||||
{
|
||||
gdbg("ERROR: init_graph_vga returned %d\n",ret);
|
||||
}
|
||||
|
||||
memset(g_pscreen, 0, VGA_XRES * VGA_YRES);
|
||||
return &g_lcddev;
|
||||
}
|
||||
|
||||
void qemu_vga(void)
|
||||
{
|
||||
int ret = init_graph_vga(VGA_XRES, VGA_YRES, 1);
|
||||
if (ret < 0)
|
||||
{
|
||||
gdbg("ERROR: init_graph_vga returned %d\n",ret);
|
||||
}
|
||||
|
||||
memset(g_pscreen, g_bg_color, VGA_XRES * VGA_YRES);
|
||||
(void)register_driver("/dev/lcd", &g_vgaops, 0666, NULL);
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user