blob: cc4d72a9f77effe0e43ec061ed252c86a67c8fc9 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
|
/*
* This file and its contents are supplied under the terms of the
* Common Development and Distribution License ("CDDL"), version 1.0.
* You may only use this file in accordance with the terms of version
* 1.0 of the CDDL.
*
* A full copy of the text of the CDDL should have accompanied this
* source. A copy of the CDDL is also available via the Internet at
* http://www.illumos.org/license/CDDL.
*/
/*
* Copyright 2022 Oxide Computer Company
*/
#include "payload_common.h"
#include "payload_utils.h"
#include "test_defs.h"
#define LAPIC_OFF_SVR 0xf0
#define LAPIC_OFF_TIMER_ICR 0x380
#define LAPIC_OFF_TIMER_CCR 0x390
#define LAPIC_OFF_TIMER_DCR 0x3e0
#define LAPIC_SVR_ENABLE 0x100
static void
write_vlapic(uint_t reg, uint32_t value)
{
volatile uint32_t *ptr = (uint32_t *)(MMIO_LAPIC_BASE + reg);
*ptr = value;
}
static uint32_t
read_vlapic(uint_t reg)
{
volatile uint32_t *ptr = (uint32_t *)(MMIO_LAPIC_BASE + reg);
return (*ptr);
}
static uint32_t
divisor_to_dcr(uint32_t inp)
{
switch (inp) {
case 1:
return (0xb);
case 2:
return (0x0);
case 4:
return (0x1);
case 8:
return (0x2);
case 16:
return (0x3);
case 32:
return (0x8);
case 64:
return (0x9);
case 128:
return (0xa);
default:
/* fail immediate if divisor is out of range */
outl(IOP_TEST_VALUE, 1);
return (0xff);
}
}
void
start(void)
{
write_vlapic(LAPIC_OFF_SVR, LAPIC_SVR_ENABLE);
/* loop for as long as the host wants */
for (;;) {
uint32_t divisor;
uint32_t start, end;
divisor = inl(IOP_TEST_PARAM);
write_vlapic(LAPIC_OFF_TIMER_DCR, divisor_to_dcr(divisor));
write_vlapic(LAPIC_OFF_TIMER_ICR, 0xffffffff);
start = read_vlapic(LAPIC_OFF_TIMER_CCR);
outl(IOP_TEST_VALUE, start);
uint32_t target = start - LAPIC_TARGET_TICKS;
do {
end = read_vlapic(LAPIC_OFF_TIMER_CCR);
/* wait for enough ticks to pass */
} while (end > target);
outl(IOP_TEST_VALUE, end);
}
}
|
