← Back to branch summary

~pmdj/ubuntu/trusty/qemu/2.9+applesmc+fadtv3

« back to all changes in this revision

Viewing changes to roms/ipxe/src/arch/x86/interface/pcbios/int13con.c

  • Committer: Phil Dennis-Jordan
  • Date: 2017-07-21 08:03:43 UTC
  • mfrom: (1.1.1)
  • Revision ID: phil@philjordan.eu-20170721080343-2yr2vdj7713czahv
New upstream release 2.9.0.

Show diffs side-by-side

added added

removed removed

Lines of Context:
roms/ipxe/src/arch/x86/interface/pcbios/int13con.c
 
1
/*
 
2
 * Copyright (C) 2015 Michael Brown <mbrown@fensystems.co.uk>.
 
3
 *
 
4
 * This program is free software; you can redistribute it and/or
 
5
 * modify it under the terms of the GNU General Public License as
 
6
 * published by the Free Software Foundation; either version 2 of the
 
7
 * License, or (at your option) any later version.
 
8
 *
 
9
 * This program is distributed in the hope that it will be useful, but
 
10
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 
11
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 
12
 * General Public License for more details.
 
13
 *
 
14
 * You should have received a copy of the GNU General Public License
 
15
 * along with this program; if not, write to the Free Software
 
16
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 
17
 * 02110-1301, USA.
 
18
 *
 
19
 * You can also choose to distribute this program under the terms of
 
20
 * the Unmodified Binary Distribution Licence (as given in the file
 
21
 * COPYING.UBDL), provided that you have satisfied its requirements.
 
22
 */
 
23
 
 
24
FILE_LICENCE ( GPL2_OR_LATER_OR_UBDL );
 
25
 
 
26
#include <stdint.h>
 
27
#include <string.h>
 
28
#include <errno.h>
 
29
#include <ipxe/console.h>
 
30
#include <ipxe/init.h>
 
31
#include <realmode.h>
 
32
#include <int13.h>
 
33
#include <config/console.h>
 
34
 
 
35
/** @file
 
36
 *
 
37
 * INT13 disk log console
 
38
 *
 
39
 */
 
40
 
 
41
/* Set default console usage if applicable */
 
42
#if ! ( defined ( CONSOLE_INT13 ) && CONSOLE_EXPLICIT ( CONSOLE_INT13 ) )
 
43
#undef CONSOLE_INT13
 
44
#define CONSOLE_INT13 ( CONSOLE_USAGE_ALL & ~CONSOLE_USAGE_LOG )
 
45
#endif
 
46
 
 
47
/** Disk drive number */
 
48
#define INT13CON_DRIVE 0x80
 
49
 
 
50
/** Log partition type */
 
51
#define INT13CON_PARTITION_TYPE 0xe0
 
52
 
 
53
/** Maximum number of outstanding unwritten characters */
 
54
#define INT13CON_MAX_UNWRITTEN 64
 
55
 
 
56
/** Log partition header */
 
57
struct int13con_header {
 
58
        /** Magic signature */
 
59
        char magic[10];
 
60
} __attribute__ (( packed ));
 
61
 
 
62
/** Log partition magic signature */
 
63
#define INT13CON_MAGIC "iPXE LOG\n\n"
 
64
 
 
65
/** Sector buffer */
 
66
static uint8_t __bss16_array ( int13con_buffer, [INT13_BLKSIZE] );
 
67
#define int13con_buffer __use_data16 ( int13con_buffer )
 
68
 
 
69
/** Disk address packet */
 
70
static struct int13_disk_address __bss16 ( int13con_address );
 
71
#define int13con_address __use_data16 ( int13con_address )
 
72
 
 
73
/** Current LBA */
 
74
static uint64_t int13con_lba;
 
75
 
 
76
/** Maximum LBA */
 
77
static uint64_t int13con_max_lba;
 
78
 
 
79
/** Current offset within sector */
 
80
static size_t int13con_offset;
 
81
 
 
82
/** Number of unwritten characters */
 
83
static size_t int13con_unwritten;
 
84
 
 
85
struct console_driver int13con __console_driver;
 
86
 
 
87
/**
 
88
 * Read/write disk sector
 
89
 *
 
90
 * @v op                Operation
 
91
 * @v lba               Logical block address
 
92
 * @ret rc              Return status code
 
93
 */
 
94
static int int13con_rw ( unsigned int op, uint64_t lba ) {
 
95
        uint8_t error;
 
96
 
 
97
        /* Construct disk address packet */
 
98
        int13con_address.bufsize = sizeof ( int13con_address );
 
99
        int13con_address.count = 1;
 
100
        int13con_address.buffer.segment = rm_ds;
 
101
        int13con_address.buffer.offset = __from_data16 ( int13con_buffer );
 
102
        int13con_address.lba = lba;
 
103
 
 
104
        /* Issue INT13 */
 
105
        __asm__ ( REAL_CODE ( "int $0x13\n\t" )
 
106
                  : "=a" ( error )
 
107
                  : "0" ( op << 8 ), "d" ( INT13CON_DRIVE ),
 
108
                    "S" ( __from_data16 ( &int13con_address ) ) );
 
109
        if ( error ) {
 
110
                DBG ( "INT13CON operation %04x failed: %02x\n",
 
111
                      op, error );
 
112
                return -EIO;
 
113
        }
 
114
 
 
115
        return 0;
 
116
}
 
117
 
 
118
/**
 
119
 * Write character to console
 
120
 *
 
121
 * @v character         Character
 
122
 */
 
123
static void int13con_putchar ( int character ) {
 
124
        static int busy;
 
125
        int rc;
 
126
 
 
127
        /* Ignore if we are already mid-logging */
 
128
        if ( busy )
 
129
                return;
 
130
        busy = 1;
 
131
 
 
132
        /* Write character to buffer */
 
133
        int13con_buffer[int13con_offset++] = character;
 
134
        int13con_unwritten++;
 
135
 
 
136
        /* Write sector to disk, if applicable */
 
137
        if ( ( int13con_offset == INT13_BLKSIZE ) ||
 
138
             ( int13con_unwritten == INT13CON_MAX_UNWRITTEN ) ||
 
139
             ( character == '\n' ) ) {
 
140
 
 
141
                /* Write sector to disk */
 
142
                if ( ( rc = int13con_rw ( INT13_EXTENDED_WRITE,
 
143
                                          int13con_lba ) ) != 0 ) {
 
144
                        DBG ( "INT13CON could not write log\n" );
 
145
                        /* Ignore and continue; there's nothing we can do */
 
146
                }
 
147
 
 
148
                /* Reset count of unwritten characters */
 
149
                int13con_unwritten = 0;
 
150
        }
 
151
 
 
152
        /* Move to next sector, if applicable */
 
153
        if ( int13con_offset == INT13_BLKSIZE ) {
 
154
 
 
155
                /* Disable console if we have run out of space */
 
156
                if ( int13con_lba >= int13con_max_lba )
 
157
                        int13con.disabled = 1;
 
158
 
 
159
                /* Clear log buffer */
 
160
                memset ( int13con_buffer, 0, sizeof ( int13con_buffer ) );
 
161
                int13con_offset = 0;
 
162
 
 
163
                /* Move to next sector */
 
164
                int13con_lba++;
 
165
        }
 
166
 
 
167
        /* Clear busy flag */
 
168
        busy = 0;
 
169
}
 
170
 
 
171
/**
 
172
 * Find log partition
 
173
 *
 
174
 * @ret rc              Return status code
 
175
 */
 
176
static int int13con_find ( void ) {
 
177
        struct master_boot_record *mbr =
 
178
                ( ( struct master_boot_record * ) int13con_buffer );
 
179
        struct int13con_header *hdr =
 
180
                ( ( struct int13con_header * ) int13con_buffer );
 
181
        struct partition_table_entry part[4];
 
182
        unsigned int i;
 
183
        int rc;
 
184
 
 
185
        /* Read MBR */
 
186
        if ( ( rc = int13con_rw ( INT13_EXTENDED_READ, 0 ) ) != 0 ) {
 
187
                DBG ( "INT13CON could not read MBR: %s\n", strerror ( rc ) );
 
188
                return rc;
 
189
        }
 
190
 
 
191
        /* Check MBR magic */
 
192
        if ( mbr->magic != INT13_MBR_MAGIC ) {
 
193
                DBG ( "INT13CON incorrect MBR magic\n" );
 
194
                DBG2_HDA ( 0, mbr, sizeof ( *mbr ) );
 
195
                return -EINVAL;
 
196
        }
 
197
 
 
198
        /* Look for magic partition */
 
199
        memcpy ( part, mbr->partitions, sizeof ( part ) );
 
200
        for ( i = 0 ; i < ( sizeof ( part ) / sizeof ( part[0] ) ) ; i++ ) {
 
201
 
 
202
                /* Skip partitions of the wrong type */
 
203
                if ( part[i].type != INT13CON_PARTITION_TYPE )
 
204
                        continue;
 
205
 
 
206
                /* Read partition header */
 
207
                if ( ( rc = int13con_rw ( INT13_EXTENDED_READ,
 
208
                                          part[i].start ) ) != 0 ) {
 
209
                        DBG ( "INT13CON partition %d could not read header: "
 
210
                              "%s\n", ( i + 1 ), strerror ( rc ) );
 
211
                        continue;
 
212
                }
 
213
 
 
214
                /* Check partition header */
 
215
                if ( memcmp ( hdr->magic, INT13CON_MAGIC,
 
216
                              sizeof ( hdr->magic ) ) != 0 ) {
 
217
                        DBG ( "INT13CON partition %d bad magic\n", ( i + 1 ) );
 
218
                        DBG2_HDA ( 0, hdr, sizeof ( *hdr ) );
 
219
                        continue;
 
220
                }
 
221
 
 
222
                /* Found log partition */
 
223
                DBG ( "INT13CON partition %d at [%08x,%08x)\n", ( i + 1 ),
 
224
                      part[i].start, ( part[i].start + part[i].length ) );
 
225
                int13con_lba = part[i].start;
 
226
                int13con_max_lba = ( part[i].start + part[i].length - 1 );
 
227
 
 
228
                /* Initialise log buffer */
 
229
                memset ( &int13con_buffer[ sizeof ( *hdr ) ], 0,
 
230
                         ( sizeof ( int13con_buffer ) - sizeof ( *hdr ) ) );
 
231
                int13con_offset = sizeof ( hdr->magic );
 
232
 
 
233
                return 0;
 
234
        }
 
235
 
 
236
        DBG ( "INT13CON found no log partition\n" );
 
237
        return -ENOENT;
 
238
}
 
239
 
 
240
/**
 
241
 * Initialise INT13 console
 
242
 *
 
243
 */
 
244
static void int13con_init ( void ) {
 
245
        uint8_t error;
 
246
        uint16_t check;
 
247
        unsigned int discard_c;
 
248
        unsigned int discard_d;
 
249
        int rc;
 
250
 
 
251
        /* Check for INT13 extensions */
 
252
        __asm__ __volatile__ ( REAL_CODE ( "int $0x13\n\t"
 
253
                                           "setc %%al\n\t" )
 
254
                               : "=a" ( error ), "=b" ( check ),
 
255
                                 "=c" ( discard_c ), "=d" ( discard_d )
 
256
                               : "0" ( INT13_EXTENSION_CHECK << 8 ),
 
257
                                 "1" ( 0x55aa ), "3" ( INT13CON_DRIVE ) );
 
258
        if ( error || ( check != 0xaa55 ) ) {
 
259
                DBG ( "INT13CON missing extensions (%02x,%04x)\n",
 
260
                      error, check );
 
261
                return;
 
262
        }
 
263
 
 
264
        /* Locate log partition */
 
265
        if ( ( rc = int13con_find() ) != 0)
 
266
                return;
 
267
 
 
268
        /* Enable console */
 
269
        int13con.disabled = 0;
 
270
}
 
271
 
 
272
/**
 
273
 * INT13 console initialisation function
 
274
 */
 
275
struct init_fn int13con_init_fn __init_fn ( INIT_CONSOLE ) = {
 
276
        .initialise = int13con_init,
 
277
};
 
278
 
 
279
/** INT13 console driver */
 
280
struct console_driver int13con __console_driver = {
 
281
        .putchar = int13con_putchar,
 
282
        .disabled = CONSOLE_DISABLED,
 
283
        .usage = CONSOLE_INT13,
 
284
};