source: trunk/hal/x86_64/core/hal_apic.c @ 153

Last change on this file since 153 was 153, checked in by max@…, 5 years ago

cleanup

File size: 10.5 KB
Line 
1/*
2 * hal_apic.c - Advanced Programmable Interrupt Controller
3 *
4 * Copyright (c) 2017 Maxime Villard
5 *
6 * This file is part of ALMOS-MKH.
7 *
8 * ALMOS-MKH is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2.0 of the License.
11 *
12 * ALMOS-MKH is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15 * General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with ALMOS-MKH.; if not, write to the Free Software Foundation,
19 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22#include <hal_types.h>
23#include <hal_boot.h>
24#include <hal_register.h>
25#include <hal_segmentation.h>
26#include <hal_apic.h>
27#include <hal_internal.h>
28
29#include <memcpy.h>
30#include <thread.h>
31#include <string.h>
32#include <process.h>
33#include <printk.h>
34#include <vmm.h>
35#include <core.h>
36#include <cluster.h>
37
38/* -------------------------------------------------------------------------- */
39
40#define PIC1_CMD        0x0020
41#define PIC1_DATA       0x0021
42#define PIC2_CMD        0x00a0
43#define PIC2_DATA       0x00a1
44
45static void hal_pic_init()
46{
47        /*
48         * Disable the PIC (8259A). We are going to use IOAPIC instead.
49         */
50        out8(PIC1_DATA, 0xff);
51        out8(PIC2_DATA, 0xff);
52}
53
54/* -------------------------------------------------------------------------- */
55
56uint64_t pit_ticks_base __in_kdata = 0;
57
58#define PIT_FREQUENCY   1193182
59#define HZ              100 /* 1/HZ = 10ms */
60
61#define PIT_TIMER0      0x40
62
63#define PIT_CMD         0x43
64#       define CMD_BINARY       0x00 /* Use Binary counter values */
65#       define CMD_BCD          0x01 /* Use Binary Coded Decimal counter values */
66#       define CMD_MODE0        0x00 /* Interrupt on Terminal Count */
67#       define CMD_MODE1        0x02 /* Hardware Retriggerable One-Shot */
68#       define CMD_MODE2        0x04 /* Rate Generator */
69#       define CMD_MODE3        0x06 /* Square Wave */
70#       define CMD_MODE4        0x08 /* Software Trigerred Strobe */
71#       define CMD_MODE5        0x0a /* Hardware Trigerred Strobe */
72#       define CMD_LATCH        0x00 /* latch counter for reading */
73#       define CMD_LSB          0x10 /* LSB, 8 bits */
74#       define CMD_MSB          0x20 /* MSB, 8 bits */
75#       define CMD_16BIT        0x30 /* LSB and MSB, 16 bits */
76#       define CMD_COUNTER0     0x00
77#       define CMD_COUNTER1     0x40
78#       define CMD_COUNTER2     0x80
79#       define CMD_READBACK     0xc0
80
81void hal_pit_init()
82{
83        /* Initialize PIT clock 0 to the maximum counter value, 65535. */
84        out8(PIT_CMD, CMD_COUNTER0|CMD_MODE2|CMD_16BIT);
85        out8(PIT_TIMER0, 0xFF);
86        out8(PIT_TIMER0, 0xFF);
87}
88
89uint64_t
90hal_pit_timer_read()
91{
92        static uint16_t last;
93
94        uint8_t lo, hi;
95        uint16_t ctr;
96        uint64_t ticks;
97
98        /* Read the current timer counter. */
99        out8(PIT_CMD, CMD_COUNTER0|CMD_LATCH);
100        lo = in8(PIT_TIMER0);
101        hi = in8(PIT_TIMER0);
102        ctr = (hi << 8) | lo;
103
104        /* If the counter has wrapped, assume we're into the next tick. */
105        if (ctr > last)
106                pit_ticks_base += 0xFFFF;
107        last = ctr;
108
109        ticks = pit_ticks_base + (0xFFFF - ctr);
110
111        return ticks;
112}
113
114/* -------------------------------------------------------------------------- */
115
116#define BAUDRATE        19200
117#define BAUDRATE_DIV    (115200 / BAUDRATE)
118
119#define RS232_COM1_BASE 0x3F8
120
121#define RS232_DATA      0x00
122#define RS232_IER       0x01
123#       define IER_RD           0x01
124#       define IER_TBE          0x02
125#       define IER_ER_BRK       0x04
126#       define IER_RS232IN      0x08
127#define RS232_DIVLO     0x00    /* when DLAB = 1 */
128#define RS232_DIVHI     0x01    /* when DLAB = 1 */
129#define RS232_IIR       0x02
130#define RS232_LCR       0x03
131#       define LCR_DATA5        0x00
132#       define LCR_DATA6        0x01
133#       define LCR_DATA7        0x02
134#       define LCR_DATA8        0x03
135#       define LCR_TWOSTOP      0x04
136#       define LCR_PARITY       0x08
137#       define LCR_EVEN         0x10
138#       define LCR_STICK        0x20
139#       define LCR_DLAB         0x80
140#define RS232_MCR       0x04
141#       define MCR_DTR          0x01
142#       define MCR_RTS          0x02
143#       define MCR_ELL          0x04
144#       define MCR_IR           0x40
145#define RS232_LSR       0x05
146#       define LSR_DR           0x01
147#       define LSR_OVR          0x02
148#       define LSR_PE           0x04
149#       define LSR_FE           0x08
150#       define LSR_BRK          0x10
151#       define LSR_TBE          0x20
152#       define LSR_TE           0x40
153#define RS232_MSR       0x06
154#       define MSR_DCTS         0x01
155#       define MSR_DDSR         0x02
156#       define MSR_DRI          0x04
157#       define MSR_DDCD         0x08
158#       define MSR_CTS          0x10
159#       define MSR_DSR          0x20
160#       define MSR_RI           0x40
161#       define MSR_DCD          0x80
162
163#define RS232_SCRATCH   0x07
164
165static bool_t hal_com_received()
166{
167        return (in8(RS232_COM1_BASE + RS232_LSR) & LSR_DR) != 0;
168}
169
170static bool_t hal_com_transmit_empty()
171{
172        return (in8(RS232_COM1_BASE + RS232_LSR) & LSR_TBE) != 0;
173}
174
175char hal_com_read()
176{
177        while (!hal_com_received());
178        return in8(RS232_COM1_BASE + RS232_DATA);
179}
180
181void hal_com_send(char c)
182{
183        uint8_t mcr = in8(RS232_COM1_BASE + RS232_MCR);
184        out8(RS232_COM1_BASE + RS232_MCR, mcr | MCR_RTS);
185
186        while (!hal_com_transmit_empty());
187        out8(RS232_COM1_BASE + RS232_DATA, c);
188
189        out8(RS232_COM1_BASE + RS232_MCR, mcr);
190}
191
192static void hal_com_init()
193{
194        /* Disable all interrupts */
195        out8(RS232_COM1_BASE + RS232_IER, 0x00);
196
197        /* Set baudrate */
198        out8(RS232_COM1_BASE + RS232_LCR, LCR_DLAB);
199        out8(RS232_COM1_BASE + RS232_DIVLO, BAUDRATE_DIV);
200        out8(RS232_COM1_BASE + RS232_DIVHI, 0);
201
202        /* 8bits, no parity, one stop bit */
203        out8(RS232_COM1_BASE + RS232_LCR, LCR_DATA8);
204
205        /* Enable IRQs, DTR set, and also DSR */
206        out8(RS232_COM1_BASE + RS232_IER, IER_RD|IER_RS232IN);
207        out8(RS232_COM1_BASE + RS232_MCR, MCR_DTR|MCR_IR);
208        out8(RS232_COM1_BASE + RS232_MSR, MSR_DSR);
209}
210
211/* -------------------------------------------------------------------------- */
212
213size_t ioapic_pins __in_kdata = 0;
214paddr_t ioapic_pa __in_kdata = 0;
215vaddr_t ioapic_va __in_kdata = 0;
216
217#define IRQ_TIMER       0x00
218#define IRQ_KEYBOARD    0x01
219#define IRQ_COM2        0x03
220#define IRQ_COM1        0x04
221#define IRQ_FLOPPY      0x06
222#define IRQ_ATA0        0x0e
223#define IRQ_ATA1        0x0f
224
225#define IOREGSEL        0x00
226#define IOWIN   0x10
227
228#define IOAPICID        0x00
229#define IOAPICVER       0x01
230#define IOAPICARB       0x02
231
232#define IOREDTBL        0x10
233#       define IOREDTBL_DEL_FIXED       0x000
234#       define IOREDTBL_DEL_LOPRI       0x100
235#       define IOREDTBL_DEL_SMI         0x200
236#       define IOREDTBL_DEL_NMI         0x400
237#       define IOREDTBL_DEL_INIT        0x500
238#       define IOREDTBL_DEL_EXTINT      0x700
239#       define IOREDTBL_DEM_PHYS        0x000
240#       define IOREDTBL_DEM_LOGIC       0x800
241#       define IOREDTBL_DES_SHIFT       56
242#       define IOREDTBL_MSK             0x10000
243
244void hal_ioapic_write(uint8_t reg, uint32_t val)
245{
246        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOREGSEL)) = reg;
247        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOWIN)) = val;
248}
249
250uint32_t hal_ioapic_read(uint8_t reg)
251{
252        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOREGSEL)) = reg;
253        return *((volatile uint32_t *)((uint8_t *)ioapic_va + IOWIN));
254}
255
256void hal_ioapic_disable_entry(uint8_t index)
257{
258        const uint64_t data = IOREDTBL_MSK;
259
260        hal_ioapic_write(IOREDTBL + index * 2, (uint32_t)(data & 0xFFFFFFFF));
261        hal_ioapic_write(IOREDTBL + index * 2 + 1, (uint32_t)(data >> 32));
262}
263
264void hal_ioapic_set_entry(uint8_t index, uint8_t vec, uint8_t dest)
265{
266        const uint64_t data = ((uint64_t)dest << IOREDTBL_DES_SHIFT) |
267            IOREDTBL_DEM_PHYS | IOREDTBL_DEL_FIXED | vec;
268
269        hal_ioapic_write(IOREDTBL + index * 2, (uint32_t)(data & 0xFFFFFFFF));
270        hal_ioapic_write(IOREDTBL + index * 2 + 1, (uint32_t)(data >> 32));
271}
272
273static void hal_ioapic_init()
274{
275        uint32_t ver;
276        size_t i;
277
278        ioapic_va = hal_gpt_bootstrap_valloc(1); // XXX: should be shared
279
280        hal_gpt_enter(ioapic_va, ioapic_pa, PG_V|PG_KW|PG_NX|PG_N);
281
282        ver = hal_ioapic_read(IOAPICVER);
283        ioapic_pins = ((ver >> 16) & 0xFF) + 1;
284
285        /* Explicitly disable (mask) each vector */
286        for (i = 0; i < ioapic_pins; i++) {
287                hal_ioapic_disable_entry(i);
288        }
289
290        x86_printf("IOAPICPINS: #%z\n", ioapic_pins);
291
292        /* Now, enable the com1 port and the keyboard */
293        hal_ioapic_set_entry(IRQ_COM1, IOAPIC_COM1_VECTOR, 0);
294        hal_ioapic_set_entry(IRQ_KEYBOARD, IOAPIC_KEYBOARD_VECTOR, 0);
295}
296
297/* -------------------------------------------------------------------------- */
298
299paddr_t lapic_pa __in_kdata = 0;
300vaddr_t lapic_va __in_kdata = 0;
301
302void hal_lapic_write(uint32_t reg, uint32_t val)
303{
304        *((volatile uint32_t *)((uint8_t *)lapic_va + reg)) = val;
305}
306
307uint32_t hal_lapic_read(uint32_t reg)
308{
309        return *((volatile uint32_t *)((uint8_t *)lapic_va + reg));
310}
311
312uint32_t hal_lapic_gid()
313{
314        return hal_lapic_read(LAPIC_ID) >> LAPIC_ID_SHIFT;
315}
316
317/*
318 * Use the PIT, which has a standard clock frequency, to determine the CPU's
319 * exact bus frequency.
320 */
321static void hal_lapic_calibrate()
322{
323        uint64_t pittick, lapictick0, lapictick1;
324        uint32_t lapicticks, lapicstart;
325
326        /* Initialize the LAPIC timer to the maximum value */
327        hal_lapic_write(LAPIC_ICR_TIMER, 0xFFFFFFFF);
328
329        /* Initialize the PIT */
330        hal_pit_init();
331
332        pittick = hal_pit_timer_read() + 1;
333        while (hal_pit_timer_read() < pittick) {
334                /* Wait until start of a PIT tick */
335        }
336
337        /* Read base count from LAPIC */
338        lapictick0 = hal_lapic_read(LAPIC_CCR_TIMER);
339
340        while (hal_pit_timer_read() < pittick + (PIT_FREQUENCY + HZ/2) / HZ) {
341                /* Wait 1/HZ sec = 10ms */
342        }
343
344        /* Read final count from LAPIC */
345        lapictick1 = hal_lapic_read(LAPIC_CCR_TIMER);
346
347        /* Total number of LAPIC ticks per 1/HZ tick */
348        lapicticks = (lapictick1 - lapictick0);
349
350        /* Finally, calibrate the timer, an interrupt each 1s. */
351        lapicstart = - (lapicticks * 100);
352        hal_lapic_write(LAPIC_ICR_TIMER, lapicstart);
353}
354
355/*
356 * We have 8 interrupt sources:
357 *  - Spurious
358 *  - APIC Timer (TMR)
359 *  - Local Interrupt 0 (LINT0)
360 *  - Local Interrupt 1 (LINT1)
361 *  - Performance Monitor Counters (PMC)
362 *  - Thermal Sensors (THM)
363 *  - APIC internal error (ERR)
364 *  - Extended (Implementation dependent)
365 * Only the Spurious and APIC Timer interrupts are enabled.
366 */
367static void hal_lapic_init()
368{
369        lapic_va = hal_gpt_bootstrap_valloc(1); // XXX: should be shared
370
371        if ((rdmsr(MSR_APICBASE) & APICBASE_PHYSADDR) != lapic_pa) {
372                x86_panic("APICBASE and ACPI don't match!\n");
373        }
374        wrmsr(MSR_APICBASE, lapic_pa | APICBASE_EN);
375
376        hal_gpt_enter(lapic_va, lapic_pa, PG_V|PG_KW|PG_NX|PG_N);
377
378        hal_lapic_write(LAPIC_TPR, 0);
379        hal_lapic_write(LAPIC_EOI, 0);
380        hal_lapic_write(LAPIC_SVR, LAPIC_SVR_ENABLE|VECTOR_APIC_SPURIOU);
381
382        /* Explicitly disable (mask) each vector */
383        hal_lapic_write(LAPIC_LVT_TMR, LAPIC_TMR_M);
384        hal_lapic_write(LAPIC_LVT_LINT0, LAPIC_LINT_M);
385        hal_lapic_write(LAPIC_LVT_LINT1, LAPIC_LINT_M);
386        hal_lapic_write(LAPIC_LVT_PMC, LAPIC_PMC_M);
387        hal_lapic_write(LAPIC_LVT_THM, LAPIC_THM_M);
388        hal_lapic_write(LAPIC_LVT_ERR, LAPIC_ERR_M);
389
390        /* Now, enable the timer in repeated mode. */
391        hal_lapic_write(LAPIC_LVT_TMR, LAPIC_TMR_TM|LAPIC_TMR_M);
392        hal_lapic_write(LAPIC_DCR_TIMER, LAPIC_DCRT_DIV1);
393        hal_lapic_calibrate();
394        hal_lapic_write(LAPIC_LVT_TMR, LAPIC_TMR_TM|LAPIC_TIMER_VECTOR);
395}
396
397/* -------------------------------------------------------------------------- */
398
399void hal_apic_init()
400{
401        /* Disable the PIC */
402        hal_pic_init();
403
404        /* Enable the LAPIC */
405        hal_lapic_init();
406
407        /* Enable the IOAPIC */
408        hal_ioapic_init();
409
410        /* Enable the Serial Port */
411        hal_com_init();
412}
413
Note: See TracBrowser for help on using the repository browser.