Rev 4343 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 4343 | Rev 4344 | ||
---|---|---|---|
Line 1... | Line 1... | ||
1 | /* |
1 | /* |
2 | * Copyright (c) 2001-2006 Jakub Jermar |
2 | * Copyright (c) 2009 Jakub Jermar |
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: |
Line 38... | Line 38... | ||
38 | #include <genarch/kbd/key.h> |
38 | #include <genarch/kbd/key.h> |
39 | #include <genarch/kbd/scanc.h> |
39 | #include <genarch/kbd/scanc.h> |
40 | #include <genarch/kbd/scanc_sun.h> |
40 | #include <genarch/kbd/scanc_sun.h> |
41 | #include <arch/drivers/kbd.h> |
41 | #include <arch/drivers/kbd.h> |
42 | #include <ddi/irq.h> |
42 | #include <ddi/irq.h> |
43 | #include <ipc/irq.h> |
- | |
44 | #include <cpu.h> |
43 | #include <cpu.h> |
45 | #include <arch/asm.h> |
44 | #include <arch/asm.h> |
46 | #include <arch.h> |
45 | #include <arch.h> |
47 | #include <console/chardev.h> |
46 | #include <console/chardev.h> |
48 | #include <console/console.h> |
47 | #include <console/console.h> |
49 | #include <interrupt.h> |
48 | #include <interrupt.h> |
50 | #include <arch/interrupt.h> |
49 | #include <arch/interrupt.h> |
51 | #include <sysinfo/sysinfo.h> |
- | |
52 | #include <synch/spinlock.h> |
50 | #include <synch/spinlock.h> |
- | 51 | #include <mm/slab.h> |
|
53 | 52 | ||
54 | #define LSR_DATA_READY 0x01 |
53 | #define LSR_DATA_READY 0x01 |
55 | 54 | ||
56 | /** Structure representing the ns16550. */ |
- | |
57 | static ns16550_t ns16550; |
- | |
58 | - | ||
59 | /** Structure for ns16550's IRQ. */ |
- | |
60 | static irq_t ns16550_irq; |
- | |
61 | - | ||
62 | /* |
55 | /* |
63 | * These codes read from ns16550 data register are silently ignored. |
56 | * These codes read from ns16550 data register are silently ignored. |
64 | */ |
57 | */ |
65 | #define IGNORE_CODE 0x7f /* all keys up */ |
58 | #define IGNORE_CODE 0x7f /* all keys up */ |
66 | 59 | ||
Line 68... | Line 61... | ||
68 | static void ns16550_resume(chardev_t *); |
61 | static void ns16550_resume(chardev_t *); |
69 | 62 | ||
70 | static chardev_operations_t ops = { |
63 | static chardev_operations_t ops = { |
71 | .suspend = ns16550_suspend, |
64 | .suspend = ns16550_suspend, |
72 | .resume = ns16550_resume, |
65 | .resume = ns16550_resume, |
73 | .read = ns16550_key_read |
- | |
74 | }; |
66 | }; |
75 | 67 | ||
76 | void ns16550_interrupt(void); |
- | |
77 | - | ||
78 | /** Initialize keyboard and service interrupts using kernel routine */ |
- | |
79 | void ns16550_grab(void) |
- | |
80 | { |
- | |
81 | ipl_t ipl = interrupts_disable(); |
- | |
82 | - | ||
83 | ns16550_ier_write(&ns16550, IER_ERBFI); /* enable receiver interrupt */ |
- | |
84 | - | ||
85 | while (ns16550_lsr_read(&ns16550) & LSR_DATA_READY) |
- | |
86 | (void) ns16550_rbr_read(&ns16550); |
- | |
87 | - | ||
88 | spinlock_lock(&ns16550_irq.lock); |
- | |
89 | ns16550_irq.notif_cfg.notify = false; |
- | |
90 | spinlock_unlock(&ns16550_irq.lock); |
- | |
91 | interrupts_restore(ipl); |
- | |
92 | } |
- | |
93 | - | ||
94 | /** Resume the former interrupt vector */ |
- | |
95 | void ns16550_release(void) |
- | |
96 | { |
- | |
97 | ipl_t ipl = interrupts_disable(); |
- | |
98 | spinlock_lock(&ns16550_irq.lock); |
- | |
99 | if (ns16550_irq.notif_cfg.answerbox) |
- | |
100 | ns16550_irq.notif_cfg.notify = true; |
- | |
101 | spinlock_unlock(&ns16550_irq.lock); |
- | |
102 | interrupts_restore(ipl); |
- | |
103 | } |
- | |
104 | - | ||
105 | /** Initialize ns16550. |
68 | /** Initialize ns16550. |
106 | * |
69 | * |
- | 70 | * @param dev Addrress of the beginning of the device in I/O space. |
|
107 | * @param devno Device number. |
71 | * @param devno Device number. |
108 | * @param port Virtual/IO address of device's registers. |
- | |
109 | * @param inr Interrupt number. |
72 | * @param inr Interrupt number. |
110 | * @param cir Clear interrupt function. |
73 | * @param cir Clear interrupt function. |
111 | * @param cir_arg First argument to cir. |
74 | * @param cir_arg First argument to cir. |
- | 75 | * |
|
- | 76 | * @return True on success, false on failure. |
|
112 | */ |
77 | */ |
113 | void |
78 | bool |
114 | ns16550_init(devno_t devno, ioport_t port, inr_t inr, cir_t cir, void *cir_arg) |
79 | ns16550_init(ns16550_t *dev, devno_t devno, inr_t inr, cir_t cir, void *cir_arg) |
115 | { |
80 | { |
- | 81 | ns16550_instance_t *instance; |
|
- | 82 | ||
116 | chardev_initialize("ns16550_kbd", &kbrd, &ops); |
83 | chardev_initialize("ns16550_kbd", &kbrd, &ops); |
117 | stdin = &kbrd; |
84 | stdin = &kbrd; |
118 | 85 | ||
- | 86 | instance = malloc(sizeof(ns16550_instance_t), FRAME_ATOMIC); |
|
- | 87 | if (!instance) |
|
- | 88 | return false; |
|
- | 89 | ||
119 | ns16550.devno = devno; |
90 | instance->devno = devno; |
120 | ns16550.io_port = port; |
91 | instance->ns16550 = dev; |
121 | 92 | ||
122 | irq_initialize(&ns16550_irq); |
93 | irq_initialize(&instance->irq); |
123 | ns16550_irq.devno = devno; |
94 | instance->irq.devno = devno; |
124 | ns16550_irq.inr = inr; |
95 | instance->irq.inr = inr; |
125 | ns16550_irq.claim = ns16550_claim; |
96 | instance->irq.claim = ns16550_claim; |
126 | ns16550_irq.handler = ns16550_irq_handler; |
97 | instance->irq.handler = ns16550_irq_handler; |
- | 98 | instance->irq.instance = instance; |
|
127 | ns16550_irq.cir = cir; |
99 | instance->irq.cir = cir; |
128 | ns16550_irq.cir_arg = cir_arg; |
100 | instance->irq.cir_arg = cir_arg; |
129 | irq_register(&ns16550_irq); |
101 | irq_register(&instance->irq); |
130 | 102 | ||
131 | while ((ns16550_lsr_read(&ns16550) & LSR_DATA_READY)) |
103 | while ((pio_read_8(&dev->lsr) & LSR_DATA_READY)) |
132 | ns16550_rbr_read(&ns16550); |
104 | (void) pio_read_8(&dev->rbr); |
133 | - | ||
134 | sysinfo_set_item_val("kbd", NULL, true); |
- | |
135 | sysinfo_set_item_val("kbd.type", NULL, KBD_NS16550); |
- | |
136 | sysinfo_set_item_val("kbd.devno", NULL, devno); |
- | |
137 | sysinfo_set_item_val("kbd.inr", NULL, inr); |
- | |
138 | sysinfo_set_item_val("kbd.address.virtual", NULL, port); |
- | |
139 | sysinfo_set_item_val("kbd.port", NULL, port); |
- | |
140 | 105 | ||
141 | /* Enable interrupts */ |
106 | /* Enable interrupts */ |
142 | ns16550_ier_write(&ns16550, IER_ERBFI); |
107 | pio_write_8(&dev->ier, IER_ERBFI); |
143 | ns16550_mcr_write(&ns16550, MCR_OUT2); |
108 | pio_write_8(&dev->mcr, MCR_OUT2); |
144 | - | ||
145 | uint8_t c; |
- | |
146 | // This switches rbr & ier to mode when accept baudrate constant |
- | |
147 | c = ns16550_lcr_read(&ns16550); |
- | |
148 | ns16550_lcr_write(&ns16550, 0x80 | c); |
- | |
149 | ns16550_rbr_write(&ns16550, 0x0c); |
- | |
150 | ns16550_ier_write(&ns16550, 0x00); |
- | |
151 | ns16550_lcr_write(&ns16550, c); |
- | |
152 | 109 | ||
153 | ns16550_grab(); |
110 | return true; |
154 | } |
- | |
155 | - | ||
156 | /** Process ns16550 interrupt. */ |
- | |
157 | void ns16550_interrupt(void) |
- | |
158 | { |
- | |
159 | ns16550_poll(); |
- | |
160 | } |
111 | } |
161 | 112 | ||
162 | /* Called from getc(). */ |
113 | /* Called from getc(). */ |
163 | void ns16550_resume(chardev_t *d) |
114 | void ns16550_resume(chardev_t *d) |
164 | { |
115 | { |
Line 167... | Line 118... | ||
167 | /* Called from getc(). */ |
118 | /* Called from getc(). */ |
168 | void ns16550_suspend(chardev_t *d) |
119 | void ns16550_suspend(chardev_t *d) |
169 | { |
120 | { |
170 | } |
121 | } |
171 | 122 | ||
172 | - | ||
173 | char ns16550_key_read(chardev_t *d) |
123 | irq_ownership_t ns16550_claim(irq_t *irq) |
174 | { |
124 | { |
- | 125 | ns16550_instance_t *ns16550_instance = irq->instance; |
|
175 | char ch; |
126 | ns16550_t *dev = ns16550_instance->ns16550; |
176 | 127 | ||
177 | while(!(ch = active_read_buff_read())) { |
- | |
178 | uint8_t x; |
- | |
179 | while (!(ns16550_lsr_read(&ns16550) & LSR_DATA_READY)); |
128 | if (pio_read_8(&dev->lsr) & LSR_DATA_READY) |
180 | - | ||
181 | x = ns16550_rbr_read(&ns16550); |
- | |
182 | - | ||
183 | if (x != IGNORE_CODE) { |
129 | return IRQ_ACCEPT; |
184 | if (x & KEY_RELEASE) |
- | |
185 | key_released(x ^ KEY_RELEASE); |
- | |
186 | else |
130 | else |
187 | active_read_key_pressed(x); |
- | |
188 | } |
- | |
189 | } |
- | |
190 | return ch; |
131 | return IRQ_DECLINE; |
191 | } |
132 | } |
192 | 133 | ||
193 | /** Poll for key press and release events. |
- | |
194 | * |
- | |
195 | * This function can be used to implement keyboard polling. |
- | |
196 | */ |
- | |
197 | void ns16550_poll(void) |
134 | void ns16550_irq_handler(irq_t *irq) |
198 | { |
135 | { |
- | 136 | ns16550_instance_t *ns16550_instance = irq->instance; |
|
- | 137 | ns16550_t *dev = ns16550_instance->ns16550; |
|
- | 138 | ||
199 | while (ns16550_lsr_read(&ns16550) & LSR_DATA_READY) { |
139 | if (pio_read_8(&dev->lsr) & LSR_DATA_READY) { |
200 | uint8_t x; |
140 | uint8_t x; |
201 | 141 | ||
202 | x = ns16550_rbr_read(&ns16550); |
142 | x = pio_read_8(&dev->rbr); |
203 | 143 | ||
204 | if (x != IGNORE_CODE) { |
144 | if (x != IGNORE_CODE) { |
205 | if (x & KEY_RELEASE) |
145 | if (x & KEY_RELEASE) |
206 | key_released(x ^ KEY_RELEASE); |
146 | key_released(x ^ KEY_RELEASE); |
207 | else |
147 | else |
208 | key_pressed(x); |
148 | key_pressed(x); |
209 | } |
149 | } |
210 | } |
150 | } |
211 | } |
- | |
212 | 151 | ||
213 | irq_ownership_t ns16550_claim(void *instance) |
- | |
214 | { |
- | |
215 | return (ns16550_lsr_read(&ns16550) & LSR_DATA_READY); |
- | |
216 | } |
- | |
217 | - | ||
218 | void ns16550_irq_handler(irq_t *irq) |
- | |
219 | { |
- | |
220 | if (irq->notif_cfg.notify && irq->notif_cfg.answerbox) |
- | |
221 | ipc_irq_send_notif(irq); |
- | |
222 | else |
- | |
223 | ns16550_interrupt(); |
- | |
224 | } |
152 | } |
225 | 153 | ||
226 | /** @} |
154 | /** @} |
227 | */ |
155 | */ |