WebSVN – HelenOS – Diff – /branches/arm/kernel/arch/arm32/src/drivers/gxemul.c


/*
 * Copyright (c) 2007 Michal Kebrt, Petr Stepan
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
 */
 
/** @addtogroup arm32
 * @{
 */
/** @file
 */
 
#include <interrupt.h>
#include <ipc/irq.h>
#include <console/chardev.h>
#include <arch/drivers/gxemul.h>
#include <console/console.h>
#include <sysinfo/sysinfo.h>
#include <print.h>
#include <ddi/device.h>
#include <mm/page.h>
#include <arch/machine.h>
#include <arch/debug/print.h>
 
 
/** Addresses of devices. */
#define GXEMUL_VIDEORAM            0x10000000
#define GXEMUL_KBD                 0x10000000
#define GXEMUL_HALT_OFFSET         0x10
#define GXEMUL_RTC                 0x15000000
#define GXEMUL_RTC_FREQ_OFFSET     0x100
#define GXEMUL_RTC_ACK_OFFSET      0x110
#define GXEMUL_IRQC                0x16000000
#define GXEMUL_IRQC_MASK_OFFSET    0x4
#define GXEMUL_IRQC_UNMASK_OFFSET  0x8
#define GXEMUL_MP                  0x11000000
#define GXEMUL_MP_MEMSIZE_OFFSET   0x0090
#define GXEMUL_FB                  0x12000000
 
 
/** IRQs */
#define GXEMUL_KBD_IRQ      2
#define GXEMUL_TIMER_IRQ    4
 
static gxemul_hw_map_t gxemul_hw_map;
static chardev_t console;
static irq_t gxemul_irq;
static irq_t gxemul_timer_irq;
 
static bool hw_map_init_called = false;
 
static void gxemul_write(chardev_t *dev, const char ch);
static void gxemul_enable(chardev_t *dev);
static void gxemul_disable(chardev_t *dev);
static char gxemul_do_read(chardev_t *dev);
 
static chardev_operations_t gxemul_ops = {
    .resume = gxemul_enable,
    .suspend = gxemul_disable,
    .write = gxemul_write,
    .read = gxemul_do_read,
};
 
 
/** Returns the mask of active interrupts. */
static inline uint32_t gxemul_irqc_get_sources(void)
{
    return *(uint32_t*) gxemul_hw_map.irqc;
}
 
 
/** Masks interrupt.
 *
 * @param irq interrupt number
 */
static inline void gxemul_irqc_mask(uint32_t irq)
{
    *(uint32_t*) gxemul_hw_map.irqc_mask = irq;
}
 
 
/** Unmasks interrupt.
 *
 * @param irq interrupt number
 */
static inline void gxemul_irqc_unmask(uint32_t irq)
{
    *(uint32_t*) gxemul_hw_map.irqc_unmask = irq;
}
 
 
/** Initializes #gxemul_hw_map. */
void gxemul_hw_map_init(void)
{
    gxemul_hw_map.videoram = hw_map(GXEMUL_VIDEORAM, PAGE_SIZE);
    gxemul_hw_map.kbd = hw_map(GXEMUL_KBD, PAGE_SIZE);
    gxemul_hw_map.rtc = hw_map(GXEMUL_RTC, PAGE_SIZE);
    gxemul_hw_map.irqc = hw_map(GXEMUL_IRQC, PAGE_SIZE);
    gxemul_hw_map.fb = hw_map(GXEMUL_FB, PAGE_SIZE);
 
    gxemul_hw_map.rtc_freq = gxemul_hw_map.rtc + GXEMUL_RTC_FREQ_OFFSET;
    gxemul_hw_map.rtc_ack = gxemul_hw_map.rtc + GXEMUL_RTC_ACK_OFFSET;
    gxemul_hw_map.irqc_mask = gxemul_hw_map.irqc + GXEMUL_IRQC_MASK_OFFSET;
    gxemul_hw_map.irqc_unmask = gxemul_hw_map.irqc + GXEMUL_IRQC_UNMASK_OFFSET;
 
    hw_map_init_called = true;
}
 
 
/** Putchar that works with gxemul */
static void gxemul_write(chardev_t *dev, const char ch)
{
    *((char *) gxemul_hw_map.videoram) = ch;
}
 
 
/* Called from getc(). */
static void gxemul_enable(chardev_t *dev)
{
    gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
}
 
 
/* Called from getc(). */
static void gxemul_disable(chardev_t *dev)
{
    gxemul_irqc_mask(GXEMUL_KBD_IRQ);
}
 
 
/** Read character using polling, assume interrupts disabled.
 *
 *  @param dev Not used.
 */
static char gxemul_do_read(chardev_t *dev)
{
    char ch;
 
    while (1) {
        ch = *((volatile char *) gxemul_hw_map.kbd);
        if (ch) {
            if (ch == '\r')
                return '\n';
            if (ch == 0x7f)
                return '\b';
            return ch;
        }
    }
}
 
 
/** Process keyboard interrupt. */
static void gxemul_irq_handler(irq_t *irq, void *arg, ...)
{
    if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox)) {
        ipc_irq_send_notif(irq);
    } else {
        char ch = 0;
       
        ch = *((char *) gxemul_hw_map.kbd);
        if (ch == '\r') {
            ch = '\n';
        }
        if (ch == 0x7f) {
            ch = '\b';
        }
        chardev_push_character(&console, ch);
    }
}
 
 
static irq_ownership_t gxemul_claim(void)
{
    return IRQ_ACCEPT;
}
 
 
void gxemul_grab_console(void)
{
    ipl_t ipl = interrupts_disable();
    spinlock_lock(&gxemul_irq.lock);
    gxemul_irq.notif_cfg.notify = false;
    spinlock_unlock(&gxemul_irq.lock);
    interrupts_restore(ipl);
}
 
 
void gxemul_release_console(void)
{
    ipl_t ipl = interrupts_disable();
    spinlock_lock(&gxemul_irq.lock);
    if (gxemul_irq.notif_cfg.answerbox) {
        gxemul_irq.notif_cfg.notify = true;
    }
    spinlock_unlock(&gxemul_irq.lock);
    interrupts_restore(ipl);
}
 
 
/** Initializes console object representing gxemul console.
 *
 *  @param Console device number.
 */
void gxemul_console_init(devno_t devno)
{
    chardev_initialize("gxemul_console", &console, &gxemul_ops);
    stdin = &console;
    stdout = &console;
   
    irq_initialize(&gxemul_irq);
    gxemul_irq.devno = devno;
    gxemul_irq.inr = GXEMUL_KBD_IRQ;
    gxemul_irq.claim = gxemul_claim;
    gxemul_irq.handler = gxemul_irq_handler;
    irq_register(&gxemul_irq);
   
    gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
   
    sysinfo_set_item_val("kbd", NULL, true);
    sysinfo_set_item_val("kbd.devno", NULL, devno);
    sysinfo_set_item_val("kbd.inr", NULL, GXEMUL_KBD_IRQ);
    sysinfo_set_item_val("kbd.address.virtual", NULL, gxemul_hw_map.kbd);
}
 
 
 
/** Starts gxemul Real Time Clock device, which asserts regular interrupts.
 *
 * @param frequency Interrupts frequency (0 disables RTC).
 */
static void gxemul_timer_start(uint32_t frequency)
{
    *(uint32_t*) gxemul_hw_map.rtc_freq = frequency;
}
 
 
static irq_ownership_t gxemul_timer_claim(void)
{
    return IRQ_ACCEPT;
}
 
 
/** Timer interrupt handler.
 *
 * @param irq Interrupt information.
 * @param arg Not used.
 */
static void gxemul_timer_irq_handler(irq_t *irq, void *arg, ...)
{
    /* TODO time drifts ??
    unsigned long drift;
 
    drift = cp0_count_read() - nextcount;
    while (drift > cp0_compare_value) {
        drift -= cp0_compare_value;
        CPU->missed_clock_ticks++;
    }
    nextcount = cp0_count_read() + cp0_compare_value - drift;
    cp0_compare_write(nextcount);
    */
 
    /*
    * We are holding a lock which prevents preemption.
    * Release the lock, call clock() and reacquire the lock again.
    */
    spinlock_unlock(&irq->lock);
    clock();
    spinlock_lock(&irq->lock);
 
    /* acknowledge tick */
    *(uint32_t*) gxemul_hw_map.rtc_ack = 0;
   
    /* TODO what's that? *
    if (virtual_timer_fnc != NULL)
        virtual_timer_fnc();
    */
}
 
 
/** Initializes and registers timer interrupt handler. */
static void gxemul_timer_irq_init()
{
    irq_initialize(&gxemul_timer_irq);
    gxemul_timer_irq.devno = device_assign_devno();
    gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;
    gxemul_timer_irq.claim = gxemul_timer_claim;
    gxemul_timer_irq.handler = gxemul_timer_irq_handler;
 
    irq_register(&gxemul_timer_irq);
}
 
 
/** Starts timer.
 *
 * Initiates regular timer interrupts after initializing
 * corresponding interrupt handler.
 */
void gxemul_timer_irq_start()
{
    gxemul_timer_irq_init();
    gxemul_timer_start(GXEMUL_TIMER_FREQ);
}
 
 
/** Returns the size of emulated memory.
 *
 * @return Size in bytes.
 */
size_t gxemul_get_memory_size(void)
{
    return  *((int*)(GXEMUL_MP + GXEMUL_MP_MEMSIZE_OFFSET));
}
 
 
void gxemul_debug_putc(char ch)
{
    char * addr = 0;
    if (!hw_map_init_called) {
        addr = (char *) GXEMUL_KBD;
    } else {
        addr = (char *) gxemul_hw_map.videoram;
    }
 
    *(addr) = ch;
}
 
 
/** Stops gxemul. */
void gxemul_cpu_halt(void)
{
    char * addr = 0;
    if (!hw_map_init_called) {
        addr = (char *) GXEMUL_KBD;
    } else {
        addr = (char *) gxemul_hw_map.videoram;
    }
   
    *(addr + GXEMUL_HALT_OFFSET) = '\0';
}
 
 
/** Gxemul specific interrupt exception handler.
 *
 * Determines sources of the interrupt from interrupt controller and
 * calls high-level handlers for them.
 *
 * @param exc_no Interrupt exception number.
 * @param istate Saved processor state.
 */
void gxemul_irq_exception(int exc_no, istate_t *istate)
{
    uint32_t sources = gxemul_irqc_get_sources();
    int i = 0;
    for (; i < GXEMUL_IRQC_MAX_IRQ; i++) {
        if (sources & (1 << i)) {
            irq_t *irq = irq_dispatch_and_lock(i);
            if (irq) {
                /* The IRQ handler was found. */
                irq->handler(irq, irq->arg);
                spinlock_unlock(&irq->lock);
            } else {
                /* Spurious interrupt.*/
                dprintf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, i);
            }
        }
    }
}
 
 
uintptr_t gxemul_get_fb_address(void)
{
    return gxemul_hw_map.fb;
}
 
/** @}
 */
 

Rev 2357	Rev 2358
1	/*	1	/*
2	* Copyright (c) 2007 Michal Kebrt, Petr Stepan	2	* Copyright (c) 2007 Michal Kebrt, Petr Stepan
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup arm32	29	/** @addtogroup arm32
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <interrupt.h>	35	#include <interrupt.h>
36	#include <ipc/irq.h>	36	#include <ipc/irq.h>
37	#include <console/chardev.h>	37	#include <console/chardev.h>
38	#include <arch/drivers/gxemul.h>	38	#include <arch/drivers/gxemul.h>
39	#include <console/console.h>	39	#include <console/console.h>
40	#include <sysinfo/sysinfo.h>	40	#include <sysinfo/sysinfo.h>
41	#include <print.h>	41	#include <print.h>
42	#include <ddi/device.h>	42	#include <ddi/device.h>
43	#include <mm/page.h>	43	#include <mm/page.h>
44	#include <arch/machine.h>	44	#include <arch/machine.h>
45	#include <arch/debug/print.h>	45	#include <arch/debug/print.h>
46		46
47		47
48	/** Addresses of devices. */	48	/** Addresses of devices. */
49	#define GXEMUL_VIDEORAM 0x10000000	49	#define GXEMUL_VIDEORAM 0x10000000
50	#define GXEMUL_KBD 0x10000000	50	#define GXEMUL_KBD 0x10000000
51	#define GXEMUL_HALT_OFFSET 0x10	51	#define GXEMUL_HALT_OFFSET 0x10
52	#define GXEMUL_RTC 0x15000000	52	#define GXEMUL_RTC 0x15000000
53	#define GXEMUL_RTC_FREQ_OFFSET 0x100	53	#define GXEMUL_RTC_FREQ_OFFSET 0x100
54	#define GXEMUL_RTC_ACK_OFFSET 0x110	54	#define GXEMUL_RTC_ACK_OFFSET 0x110
55	#define GXEMUL_IRQC 0x16000000	55	#define GXEMUL_IRQC 0x16000000
56	#define GXEMUL_IRQC_MASK_OFFSET 0x4	56	#define GXEMUL_IRQC_MASK_OFFSET 0x4
57	#define GXEMUL_IRQC_UNMASK_OFFSET 0x8	57	#define GXEMUL_IRQC_UNMASK_OFFSET 0x8
58	#define GXEMUL_MP 0x11000000	58	#define GXEMUL_MP 0x11000000
59	#define GXEMUL_MP_MEMSIZE_OFFSET 0x0090	59	#define GXEMUL_MP_MEMSIZE_OFFSET 0x0090
60	#define GXEMUL_FB 0x12000000	60	#define GXEMUL_FB 0x12000000
61		61
62		62
63	/** IRQs */	63	/** IRQs */
64	#define GXEMUL_KBD_IRQ 2	64	#define GXEMUL_KBD_IRQ 2
65	#define GXEMUL_TIMER_IRQ 4	65	#define GXEMUL_TIMER_IRQ 4
66		66
67	static gxemul_hw_map_t gxemul_hw_map;	67	static gxemul_hw_map_t gxemul_hw_map;
68	static chardev_t console;	68	static chardev_t console;
69	static irq_t gxemul_irq;	69	static irq_t gxemul_irq;
70	static irq_t gxemul_timer_irq;	70	static irq_t gxemul_timer_irq;
71		71
72	static bool hw_map_init_called = false;	72	static bool hw_map_init_called = false;
73		73
74	static void gxemul_write(chardev_t *dev, const char ch);	74	static void gxemul_write(chardev_t *dev, const char ch);
75	static void gxemul_enable(chardev_t *dev);	75	static void gxemul_enable(chardev_t *dev);
76	static void gxemul_disable(chardev_t *dev);	76	static void gxemul_disable(chardev_t *dev);
77	static char gxemul_do_read(chardev_t *dev);	77	static char gxemul_do_read(chardev_t *dev);
78		78
79	static chardev_operations_t gxemul_ops = {	79	static chardev_operations_t gxemul_ops = {
80	.resume = gxemul_enable,	80	.resume = gxemul_enable,
81	.suspend = gxemul_disable,	81	.suspend = gxemul_disable,
82	.write = gxemul_write,	82	.write = gxemul_write,
83	.read = gxemul_do_read,	83	.read = gxemul_do_read,
84	};	84	};
85		85
86		86
87	/** Returns the mask of active interrupts. */	87	/** Returns the mask of active interrupts. */
88	static inline uint32_t gxemul_irqc_get_sources(void)	88	static inline uint32_t gxemul_irqc_get_sources(void)
89	{	89	{
90	return (uint32_t) gxemul_hw_map.irqc;	90	return (uint32_t) gxemul_hw_map.irqc;
91	}	91	}
92		92
93		93
94	/** Masks interrupt.	94	/** Masks interrupt.
95	*	95	*
96	* @param irq interrupt number	96	* @param irq interrupt number
97	*/	97	*/
98	static inline void gxemul_irqc_mask(uint32_t irq)	98	static inline void gxemul_irqc_mask(uint32_t irq)
99	{	99	{
100	(uint32_t) gxemul_hw_map.irqc_mask = irq;	100	(uint32_t) gxemul_hw_map.irqc_mask = irq;
101	}	101	}
102		102
103		103
104	/** Unmasks interrupt.	104	/** Unmasks interrupt.
105	*	105	*
106	* @param irq interrupt number	106	* @param irq interrupt number
107	*/	107	*/
108	static inline void gxemul_irqc_unmask(uint32_t irq)	108	static inline void gxemul_irqc_unmask(uint32_t irq)
109	{	109	{
110	(uint32_t) gxemul_hw_map.irqc_unmask = irq;	110	(uint32_t) gxemul_hw_map.irqc_unmask = irq;
111	}	111	}
112		112
113		113
114	/** Initializes #gxemul_hw_map. */	114	/** Initializes #gxemul_hw_map. */
115	void machine_hw_map_init(void)	115	void gxemul_hw_map_init(void)
116	{	116	{
117	gxemul_hw_map.videoram = hw_map(GXEMUL_VIDEORAM, PAGE_SIZE);	117	gxemul_hw_map.videoram = hw_map(GXEMUL_VIDEORAM, PAGE_SIZE);
118	gxemul_hw_map.kbd = hw_map(GXEMUL_KBD, PAGE_SIZE);	118	gxemul_hw_map.kbd = hw_map(GXEMUL_KBD, PAGE_SIZE);
119	gxemul_hw_map.rtc = hw_map(GXEMUL_RTC, PAGE_SIZE);	119	gxemul_hw_map.rtc = hw_map(GXEMUL_RTC, PAGE_SIZE);
120	gxemul_hw_map.irqc = hw_map(GXEMUL_IRQC, PAGE_SIZE);	120	gxemul_hw_map.irqc = hw_map(GXEMUL_IRQC, PAGE_SIZE);
121	gxemul_hw_map.fb = hw_map(GXEMUL_FB, PAGE_SIZE);	121	gxemul_hw_map.fb = hw_map(GXEMUL_FB, PAGE_SIZE);
122		122
123	gxemul_hw_map.rtc_freq = gxemul_hw_map.rtc + GXEMUL_RTC_FREQ_OFFSET;	123	gxemul_hw_map.rtc_freq = gxemul_hw_map.rtc + GXEMUL_RTC_FREQ_OFFSET;
124	gxemul_hw_map.rtc_ack = gxemul_hw_map.rtc + GXEMUL_RTC_ACK_OFFSET;	124	gxemul_hw_map.rtc_ack = gxemul_hw_map.rtc + GXEMUL_RTC_ACK_OFFSET;
125	gxemul_hw_map.irqc_mask = gxemul_hw_map.irqc + GXEMUL_IRQC_MASK_OFFSET;	125	gxemul_hw_map.irqc_mask = gxemul_hw_map.irqc + GXEMUL_IRQC_MASK_OFFSET;
126	gxemul_hw_map.irqc_unmask = gxemul_hw_map.irqc + GXEMUL_IRQC_UNMASK_OFFSET;	126	gxemul_hw_map.irqc_unmask = gxemul_hw_map.irqc + GXEMUL_IRQC_UNMASK_OFFSET;
127		127
128	hw_map_init_called = true;	128	hw_map_init_called = true;
129	}	129	}
130		130
131		131
132	/** Putchar that works with gxemul */	132	/** Putchar that works with gxemul */
133	static void gxemul_write(chardev_t *dev, const char ch)	133	static void gxemul_write(chardev_t *dev, const char ch)
134	{	134	{
135	((char ) gxemul_hw_map.videoram) = ch;	135	((char ) gxemul_hw_map.videoram) = ch;
136	}	136	}
137		137
138		138
139	/* Called from getc(). */	139	/* Called from getc(). */
140	static void gxemul_enable(chardev_t *dev)	140	static void gxemul_enable(chardev_t *dev)
141	{	141	{
142	gxemul_irqc_unmask(GXEMUL_KBD_IRQ);	142	gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
143	}	143	}
144		144
145		145
146	/* Called from getc(). */	146	/* Called from getc(). */
147	static void gxemul_disable(chardev_t *dev)	147	static void gxemul_disable(chardev_t *dev)
148	{	148	{
149	gxemul_irqc_mask(GXEMUL_KBD_IRQ);	149	gxemul_irqc_mask(GXEMUL_KBD_IRQ);
150	}	150	}
151		151
152		152
153	/** Read character using polling, assume interrupts disabled.	153	/** Read character using polling, assume interrupts disabled.
154	*	154	*
155	* @param dev Not used.	155	* @param dev Not used.
156	*/	156	*/
157	static char gxemul_do_read(chardev_t *dev)	157	static char gxemul_do_read(chardev_t *dev)
158	{	158	{
159	char ch;	159	char ch;
160		160
161	while (1) {	161	while (1) {
162	ch = ((volatile char ) gxemul_hw_map.kbd);	162	ch = ((volatile char ) gxemul_hw_map.kbd);
163	if (ch) {	163	if (ch) {
164	if (ch == '\r')	164	if (ch == '\r')
165	return '\n';	165	return '\n';
166	if (ch == 0x7f)	166	if (ch == 0x7f)
167	return '\b';	167	return '\b';
168	return ch;	168	return ch;
169	}	169	}
170	}	170	}
171	}	171	}
172		172
173		173
174	/** Process keyboard interrupt. */	174	/** Process keyboard interrupt. */
175	static void gxemul_irq_handler(irq_t irq, void arg, ...)	175	static void gxemul_irq_handler(irq_t irq, void arg, ...)
176	{	176	{
177	if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox)) {	177	if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox)) {
178	ipc_irq_send_notif(irq);	178	ipc_irq_send_notif(irq);
179	} else {	179	} else {
180	char ch = 0;	180	char ch = 0;
181		181
182	ch = ((char ) gxemul_hw_map.kbd);	182	ch = ((char ) gxemul_hw_map.kbd);
183	if (ch == '\r') {	183	if (ch == '\r') {
184	ch = '\n';	184	ch = '\n';
185	}	185	}
186	if (ch == 0x7f) {	186	if (ch == 0x7f) {
187	ch = '\b';	187	ch = '\b';
188	}	188	}
189	chardev_push_character(&console, ch);	189	chardev_push_character(&console, ch);
190	}	190	}
191	}	191	}
192		192
193		193
194	static irq_ownership_t gxemul_claim(void)	194	static irq_ownership_t gxemul_claim(void)
195	{	195	{
196	return IRQ_ACCEPT;	196	return IRQ_ACCEPT;
197	}	197	}
198		198
199		199
200	void machine_grab_console(void)	200	void gxemul_grab_console(void)
201	{	201	{
202	ipl_t ipl = interrupts_disable();	202	ipl_t ipl = interrupts_disable();
203	spinlock_lock(&gxemul_irq.lock);	203	spinlock_lock(&gxemul_irq.lock);
204	gxemul_irq.notif_cfg.notify = false;	204	gxemul_irq.notif_cfg.notify = false;
205	spinlock_unlock(&gxemul_irq.lock);	205	spinlock_unlock(&gxemul_irq.lock);
206	interrupts_restore(ipl);	206	interrupts_restore(ipl);
207	}	207	}
208		208
209		209
210	void machine_release_console(void)	210	void gxemul_release_console(void)
211	{	211	{
212	ipl_t ipl = interrupts_disable();	212	ipl_t ipl = interrupts_disable();
213	spinlock_lock(&gxemul_irq.lock);	213	spinlock_lock(&gxemul_irq.lock);
214	if (gxemul_irq.notif_cfg.answerbox) {	214	if (gxemul_irq.notif_cfg.answerbox) {
215	gxemul_irq.notif_cfg.notify = true;	215	gxemul_irq.notif_cfg.notify = true;
216	}	216	}
217	spinlock_unlock(&gxemul_irq.lock);	217	spinlock_unlock(&gxemul_irq.lock);
218	interrupts_restore(ipl);	218	interrupts_restore(ipl);
219	}	219	}
220		220
221		221
222	/** Initializes console object representing gxemul console.	222	/** Initializes console object representing gxemul console.
223	*	223	*
224	* @param Console device number.	224	* @param Console device number.
225	*/	225	*/
226	void machine_console_init(devno_t devno)	226	void gxemul_console_init(devno_t devno)
227	{	227	{
228	chardev_initialize("gxemul_console", &console, &gxemul_ops);	228	chardev_initialize("gxemul_console", &console, &gxemul_ops);
229	stdin = &console;	229	stdin = &console;
230	stdout = &console;	230	stdout = &console;
231		231
232	irq_initialize(&gxemul_irq);	232	irq_initialize(&gxemul_irq);
233	gxemul_irq.devno = devno;	233	gxemul_irq.devno = devno;
234	gxemul_irq.inr = GXEMUL_KBD_IRQ;	234	gxemul_irq.inr = GXEMUL_KBD_IRQ;
235	gxemul_irq.claim = gxemul_claim;	235	gxemul_irq.claim = gxemul_claim;
236	gxemul_irq.handler = gxemul_irq_handler;	236	gxemul_irq.handler = gxemul_irq_handler;
237	irq_register(&gxemul_irq);	237	irq_register(&gxemul_irq);
238		238
239	gxemul_irqc_unmask(GXEMUL_KBD_IRQ);	239	gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
240		240
241	sysinfo_set_item_val("kbd", NULL, true);	241	sysinfo_set_item_val("kbd", NULL, true);
242	sysinfo_set_item_val("kbd.devno", NULL, devno);	242	sysinfo_set_item_val("kbd.devno", NULL, devno);
243	sysinfo_set_item_val("kbd.inr", NULL, GXEMUL_KBD_IRQ);	243	sysinfo_set_item_val("kbd.inr", NULL, GXEMUL_KBD_IRQ);
244	sysinfo_set_item_val("kbd.address.virtual", NULL, gxemul_hw_map.kbd);	244	sysinfo_set_item_val("kbd.address.virtual", NULL, gxemul_hw_map.kbd);
245	}	245	}
246		246
247		247
248		248
249	/** Starts gxemul Real Time Clock device, which asserts regular interrupts.	249	/** Starts gxemul Real Time Clock device, which asserts regular interrupts.
250	*	250	*
251	* @param frequency Interrupts frequency (0 disables RTC).	251	* @param frequency Interrupts frequency (0 disables RTC).
252	*/	252	*/
253	static void gxemul_timer_start(uint32_t frequency)	253	static void gxemul_timer_start(uint32_t frequency)
254	{	254	{
255	(uint32_t) gxemul_hw_map.rtc_freq = frequency;	255	(uint32_t) gxemul_hw_map.rtc_freq = frequency;
256	}	256	}
257		257
258		258
259	static irq_ownership_t gxemul_timer_claim(void)	259	static irq_ownership_t gxemul_timer_claim(void)
260	{	260	{
261	return IRQ_ACCEPT;	261	return IRQ_ACCEPT;
262	}	262	}
263		263
264		264
265	/** Timer interrupt handler.	265	/** Timer interrupt handler.
266	*	266	*
267	* @param irq Interrupt information.	267	* @param irq Interrupt information.
268	* @param arg Not used.	268	* @param arg Not used.
269	*/	269	*/
270	static void gxemul_timer_irq_handler(irq_t irq, void arg, ...)	270	static void gxemul_timer_irq_handler(irq_t irq, void arg, ...)
271	{	271	{
272	/* TODO time drifts ??	272	/* TODO time drifts ??
273	unsigned long drift;	273	unsigned long drift;
274		274
275	drift = cp0_count_read() - nextcount;	275	drift = cp0_count_read() - nextcount;
276	while (drift > cp0_compare_value) {	276	while (drift > cp0_compare_value) {
277	drift -= cp0_compare_value;	277	drift -= cp0_compare_value;
278	CPU->missed_clock_ticks++;	278	CPU->missed_clock_ticks++;
279	}	279	}
280	nextcount = cp0_count_read() + cp0_compare_value - drift;	280	nextcount = cp0_count_read() + cp0_compare_value - drift;
281	cp0_compare_write(nextcount);	281	cp0_compare_write(nextcount);
282	*/	282	*/
283		283
284	/*	284	/*
285	* We are holding a lock which prevents preemption.	285	* We are holding a lock which prevents preemption.
286	* Release the lock, call clock() and reacquire the lock again.	286	* Release the lock, call clock() and reacquire the lock again.
287	*/	287	*/
288	spinlock_unlock(&irq->lock);	288	spinlock_unlock(&irq->lock);
289	clock();	289	clock();
290	spinlock_lock(&irq->lock);	290	spinlock_lock(&irq->lock);
291		291
292	/* acknowledge tick */	292	/* acknowledge tick */
293	(uint32_t) gxemul_hw_map.rtc_ack = 0;	293	(uint32_t) gxemul_hw_map.rtc_ack = 0;
294		294
295	/* TODO what's that? *	295	/* TODO what's that? *
296	if (virtual_timer_fnc != NULL)	296	if (virtual_timer_fnc != NULL)
297	virtual_timer_fnc();	297	virtual_timer_fnc();
298	*/	298	*/
299	}	299	}
300		300
301		301
302	/** Initializes and registers timer interrupt handler. */	302	/** Initializes and registers timer interrupt handler. */
303	static void gxemul_timer_irq_init()	303	static void gxemul_timer_irq_init()
304	{	304	{
305	irq_initialize(&gxemul_timer_irq);	305	irq_initialize(&gxemul_timer_irq);
306	gxemul_timer_irq.devno = device_assign_devno();	306	gxemul_timer_irq.devno = device_assign_devno();
307	gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;	307	gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;
308	gxemul_timer_irq.claim = gxemul_timer_claim;	308	gxemul_timer_irq.claim = gxemul_timer_claim;
309	gxemul_timer_irq.handler = gxemul_timer_irq_handler;	309	gxemul_timer_irq.handler = gxemul_timer_irq_handler;
310		310
311	irq_register(&gxemul_timer_irq);	311	irq_register(&gxemul_timer_irq);
312	}	312	}
313		313
314		314
315	/** Starts timer.	315	/** Starts timer.
316	*	316	*
317	* Initiates regular timer interrupts after initializing	317	* Initiates regular timer interrupts after initializing
318	* corresponding interrupt handler.	318	* corresponding interrupt handler.
319	*/	319	*/
320	void machine_timer_irq_start()	320	void gxemul_timer_irq_start()
321	{	321	{
322	gxemul_timer_irq_init();	322	gxemul_timer_irq_init();
323	gxemul_timer_start(GXEMUL_TIMER_FREQ);	323	gxemul_timer_start(GXEMUL_TIMER_FREQ);
324	}	324	}
325		325
326		326
327	/** Returns the size of emulated memory.	327	/** Returns the size of emulated memory.
328	*	328	*
329	* @return Size in bytes.	329	* @return Size in bytes.
330	*/	330	*/
331	size_t machine_get_memory_size(void)	331	size_t gxemul_get_memory_size(void)
332	{	332	{
333	return ((int)(GXEMUL_MP + GXEMUL_MP_MEMSIZE_OFFSET));	333	return ((int)(GXEMUL_MP + GXEMUL_MP_MEMSIZE_OFFSET));
334	}	334	}
335		335
336		336
337	void machine_debug_putc(char ch)	337	void gxemul_debug_putc(char ch)
338	{	338	{
339	char * addr = 0;	339	char * addr = 0;
340	if (!hw_map_init_called) {	340	if (!hw_map_init_called) {
341	addr = (char *) GXEMUL_KBD;	341	addr = (char *) GXEMUL_KBD;
342	} else {	342	} else {
343	addr = (char *) gxemul_hw_map.videoram;	343	addr = (char *) gxemul_hw_map.videoram;
344	}	344	}
345		345
346	*(addr) = ch;	346	*(addr) = ch;
347	}	347	}
348		348
349		349
350	/** Stops gxemul. */	350	/** Stops gxemul. */
351	void machine_cpu_halt(void)	351	void gxemul_cpu_halt(void)
352	{	352	{
353	char * addr = 0;	353	char * addr = 0;
354	if (!hw_map_init_called) {	354	if (!hw_map_init_called) {
355	addr = (char *) GXEMUL_KBD;	355	addr = (char *) GXEMUL_KBD;
356	} else {	356	} else {
357	addr = (char *) gxemul_hw_map.videoram;	357	addr = (char *) gxemul_hw_map.videoram;
358	}	358	}
359		359
360	*(addr + GXEMUL_HALT_OFFSET) = '\0';	360	*(addr + GXEMUL_HALT_OFFSET) = '\0';
361	}	361	}
362		362
363		363
364	/** Gxemul specific interrupt exception handler.	364	/** Gxemul specific interrupt exception handler.
365	*	365	*
366	* Determines sources of the interrupt from interrupt controller and	366	* Determines sources of the interrupt from interrupt controller and
367	* calls high-level handlers for them.	367	* calls high-level handlers for them.
368	*	368	*
369	* @param exc_no Interrupt exception number.	369	* @param exc_no Interrupt exception number.
370	* @param istate Saved processor state.	370	* @param istate Saved processor state.
371	*/	371	*/
372	void machine_irq_exception(int exc_no, istate_t *istate)	372	void gxemul_irq_exception(int exc_no, istate_t *istate)
373	{	373	{
374	uint32_t sources = gxemul_irqc_get_sources();	374	uint32_t sources = gxemul_irqc_get_sources();
375	int i = 0;	375	int i = 0;
376	for (; i < GXEMUL_IRQC_MAX_IRQ; i++) {	376	for (; i < GXEMUL_IRQC_MAX_IRQ; i++) {
377	if (sources & (1 << i)) {	377	if (sources & (1 << i)) {
378	irq_t *irq = irq_dispatch_and_lock(i);	378	irq_t *irq = irq_dispatch_and_lock(i);
379	if (irq) {	379	if (irq) {
380	/* The IRQ handler was found. */	380	/* The IRQ handler was found. */
381	irq->handler(irq, irq->arg);	381	irq->handler(irq, irq->arg);
382	spinlock_unlock(&irq->lock);	382	spinlock_unlock(&irq->lock);
383	} else {	383	} else {
384	/* Spurious interrupt.*/	384	/* Spurious interrupt.*/
385	dprintf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, i);	385	dprintf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, i);
386	}	386	}
387	}	387	}
388	}	388	}
389	}	389	}
390		390
391		391
392	uintptr_t machine_get_fb_address(void)	392	uintptr_t gxemul_get_fb_address(void)
393	{	393	{
394	return gxemul_hw_map.fb;	394	return gxemul_hw_map.fb;
395	}	395	}
396		396
397	/** @}	397	/** @}
398	*/	398	*/
399		399

Subversion Repositories HelenOS

(root)/branches/arm/kernel/arch/arm32/src/drivers/gxemul.c – Rev 2357 → 2358