1 // SPDX-License-Identifier: GPL-2.0
2 #include "wakeup.h"
3 #include "boot.h"
4
udelay(int loops)5 static void udelay(int loops)
6 {
7 while (loops--)
8 io_delay(); /* Approximately 1 us */
9 }
10
beep(unsigned int hz)11 static void beep(unsigned int hz)
12 {
13 u8 enable;
14
15 if (!hz) {
16 enable = 0x00; /* Turn off speaker */
17 } else {
18 u16 div = 1193181/hz;
19
20 outb(0xb6, 0x43); /* Ctr 2, squarewave, load, binary */
21 io_delay();
22 outb(div, 0x42); /* LSB of counter */
23 io_delay();
24 outb(div >> 8, 0x42); /* MSB of counter */
25 io_delay();
26
27 enable = 0x03; /* Turn on speaker */
28 }
29 inb(0x61); /* Dummy read of System Control Port B */
30 io_delay();
31 outb(enable, 0x61); /* Enable timer 2 output to speaker */
32 io_delay();
33 }
34
35 #define DOT_HZ 880
36 #define DASH_HZ 587
37 #define US_PER_DOT 125000
38
39 /* Okay, this is totally silly, but it's kind of fun. */
send_morse(const char * pattern)40 static void send_morse(const char *pattern)
41 {
42 char s;
43
44 while ((s = *pattern++)) {
45 switch (s) {
46 case '.':
47 beep(DOT_HZ);
48 udelay(US_PER_DOT);
49 beep(0);
50 udelay(US_PER_DOT);
51 break;
52 case '-':
53 beep(DASH_HZ);
54 udelay(US_PER_DOT * 3);
55 beep(0);
56 udelay(US_PER_DOT);
57 break;
58 default: /* Assume it's a space */
59 udelay(US_PER_DOT * 3);
60 break;
61 }
62 }
63 }
64
main(void)65 void main(void)
66 {
67 /* Kill machine if structures are wrong */
68 if (wakeup_header.real_magic != 0x12345678)
69 while (1)
70 ;
71
72 if (wakeup_header.realmode_flags & 4)
73 send_morse("...-");
74
75 if (wakeup_header.realmode_flags & 1)
76 asm volatile("lcallw $0xc000,$3");
77
78 if (wakeup_header.realmode_flags & 2) {
79 /* Need to call BIOS */
80 probe_cards(0);
81 set_mode(wakeup_header.video_mode);
82 }
83 }
84