]> Git Repo - qemu.git/blame - hw/ide/core.c
projects / qemu.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
QMP: Emit asynchronous events on all QMP monitors
[qemu.git] / hw / ide / core.c
CommitLineData
5391d806 1/*
38cdea7c 2 * QEMU IDE disk and CD/DVD-ROM Emulator
5fafdf24 3 *
5391d806 4 * Copyright (c) 2003 Fabrice Bellard
201a51fc 5 * Copyright (c) 2006 Openedhand Ltd.
5fafdf24 6 *
5391d806
FB		 7 * Permission is hereby granted, free of charge, to any person obtaining a copy
8 * of this software and associated documentation files (the "Software"), to deal
9 * in the Software without restriction, including without limitation the rights
10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11 * copies of the Software, and to permit persons to whom the Software is
12 * furnished to do so, subject to the following conditions:
13 *
14 * The above copyright notice and this permission notice shall be included in
15 * all copies or substantial portions of the Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
23 * THE SOFTWARE.
24 */
59f2a787
GH		 25#include <hw/hw.h>
26#include <hw/pc.h>
27#include <hw/pci.h>
43b443b6 28#include <hw/scsi.h>
59f2a787 29#include <hw/sh.h>
87ecb68b 30#include "block.h"
b0a7b120 31#include "block_int.h"
87ecb68b
PB		 32#include "qemu-timer.h"
33#include "sysemu.h"
1fb8648d 34#include "dma.h"
59f2a787
GH		 35
36#include <hw/ide/internal.h>
e8b54394
BW		 37
38static int smart_attributes[][5] = {
39 /* id, flags, val, wrst, thrsh */
40 { 0x01, 0x03, 0x64, 0x64, 0x06}, /* raw read */
41 { 0x03, 0x03, 0x64, 0x64, 0x46}, /* spin up */
42 { 0x04, 0x02, 0x64, 0x64, 0x14}, /* start stop count */
43 { 0x05, 0x03, 0x64, 0x64, 0x36}, /* remapped sectors */
44 { 0x00, 0x00, 0x00, 0x00, 0x00}
45};
46
8114e9e8
TS		 47/* XXX: DVDs that could fit on a CD will be reported as a CD */
48static inline int media_present(IDEState *s)
49{
50 return (s->nb_sectors > 0);
51}
52
53static inline int media_is_dvd(IDEState *s)
54{
55 return (media_present(s) && s->nb_sectors > CD_MAX_SECTORS);
56}
57
58static inline int media_is_cd(IDEState *s)
59{
60 return (media_present(s) && s->nb_sectors <= CD_MAX_SECTORS);
61}
62
8ccad811 63static void ide_dma_start(IDEState *s, BlockDriverCompletionFunc *dma_cb);
ce4b6522 64static void ide_dma_restart(IDEState *s, int is_read);
5f12ab4b 65static void ide_atapi_cmd_read_dma_cb(void *opaque, int ret);
ce4b6522 66static int ide_handle_rw_error(IDEState *s, int error, int op);
98087450 67
5391d806
FB		 68static void padstr(char *str, const char *src, int len)
69{
70 int i, v;
71 for(i = 0; i < len; i++) {
72 if (*src)
73 v = *src++;
74 else
75 v = ' ';
69b34976 76 str[i^1] = v;
5391d806
FB		 77 }
78}
79
bd0d90b2
FB		 80static void padstr8(uint8_t *buf, int buf_size, const char *src)
81{
82 int i;
83 for(i = 0; i < buf_size; i++) {
84 if (*src)
85 buf[i] = *src++;
86 else
87 buf[i] = ' ';
88 }
89}
90
67b915a5
FB		 91static void put_le16(uint16_t *p, unsigned int v)
92{
0c4ad8dc 93 *p = cpu_to_le16(v);
67b915a5
FB		 94}
95
5391d806
FB		 96static void ide_identify(IDEState *s)
97{
98 uint16_t *p;
99 unsigned int oldsize;
100
94458802
FB		 101 if (s->identify_set) {
102 memcpy(s->io_buffer, s->identify_data, sizeof(s->identify_data));
103 return;
104 }
105
5391d806
FB		 106 memset(s->io_buffer, 0, 512);
107 p = (uint16_t *)s->io_buffer;
67b915a5 108 put_le16(p + 0, 0x0040);
5fafdf24 109 put_le16(p + 1, s->cylinders);
67b915a5
FB		 110 put_le16(p + 3, s->heads);
111 put_le16(p + 4, 512 * s->sectors); /* XXX: retired, remove ? */
112 put_le16(p + 5, 512); /* XXX: retired, remove ? */
5fafdf24 113 put_le16(p + 6, s->sectors);
fa879c64 114 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */
67b915a5
FB		 115 put_le16(p + 20, 3); /* XXX: retired, remove ? */
116 put_le16(p + 21, 512); /* cache size in sectors */
117 put_le16(p + 22, 4); /* ecc bytes */
60fe76f3
TS		 118 padstr((char *)(p + 23), QEMU_VERSION, 8); /* firmware version */
119 padstr((char *)(p + 27), "QEMU HARDDISK", 40); /* model */
3b46e624 120#if MAX_MULT_SECTORS > 1
67b915a5 121 put_le16(p + 47, 0x8000 | MAX_MULT_SECTORS);
5391d806 122#endif
67b915a5 123 put_le16(p + 48, 1); /* dword I/O */
94458802 124 put_le16(p + 49, (1 << 11) | (1 << 9) | (1 << 8)); /* DMA and LBA supported */
67b915a5
FB		 125 put_le16(p + 51, 0x200); /* PIO transfer cycle */
126 put_le16(p + 52, 0x200); /* DMA transfer cycle */
94458802 127 put_le16(p + 53, 1 | (1 << 1) | (1 << 2)); /* words 54-58,64-70,88 are valid */
67b915a5
FB		 128 put_le16(p + 54, s->cylinders);
129 put_le16(p + 55, s->heads);
130 put_le16(p + 56, s->sectors);
5391d806 131 oldsize = s->cylinders * s->heads * s->sectors;
67b915a5
FB		 132 put_le16(p + 57, oldsize);
133 put_le16(p + 58, oldsize >> 16);
5391d806 134 if (s->mult_sectors)
67b915a5
FB		 135 put_le16(p + 59, 0x100 | s->mult_sectors);
136 put_le16(p + 60, s->nb_sectors);
137 put_le16(p + 61, s->nb_sectors >> 16);
d1b5c20d 138 put_le16(p + 62, 0x07); /* single word dma0-2 supported */
94458802
FB		 139 put_le16(p + 63, 0x07); /* mdma0-2 supported */
140 put_le16(p + 65, 120);
141 put_le16(p + 66, 120);
142 put_le16(p + 67, 120);
143 put_le16(p + 68, 120);
144 put_le16(p + 80, 0xf0); /* ata3 -> ata6 supported */
145 put_le16(p + 81, 0x16); /* conforms to ata5 */
e8b54394
BW		 146 /* 14=NOP supported, 0=SMART supported */
147 put_le16(p + 82, (1 << 14) | 1);
c2ff060f
FB		 148 /* 13=flush_cache_ext,12=flush_cache,10=lba48 */
149 put_le16(p + 83, (1 << 14) | (1 << 13) | (1 <<12) | (1 << 10));
e8b54394
BW		 150 /* 14=set to 1, 1=SMART self test, 0=SMART error logging */
151 put_le16(p + 84, (1 << 14) | 0);
e900a7b7
CH		 152 /* 14 = NOP supported, 5=WCACHE enabled, 0=SMART feature set enabled */
153 if (bdrv_enable_write_cache(s->bs))
154 put_le16(p + 85, (1 << 14) | (1 << 5) | 1);
155 else
156 put_le16(p + 85, (1 << 14) | 1);
c2ff060f
FB		 157 /* 13=flush_cache_ext,12=flush_cache,10=lba48 */
158 put_le16(p + 86, (1 << 14) | (1 << 13) | (1 <<12) | (1 << 10));
e8b54394
BW		 159 /* 14=set to 1, 1=smart self test, 0=smart error logging */
160 put_le16(p + 87, (1 << 14) | 0);
94458802
FB		 161 put_le16(p + 88, 0x3f | (1 << 13)); /* udma5 set and supported */
162 put_le16(p + 93, 1 | (1 << 14) | 0x2000);
c2ff060f
FB		 163 put_le16(p + 100, s->nb_sectors);
164 put_le16(p + 101, s->nb_sectors >> 16);
165 put_le16(p + 102, s->nb_sectors >> 32);
166 put_le16(p + 103, s->nb_sectors >> 48);
94458802
FB		 167
168 memcpy(s->identify_data, p, sizeof(s->identify_data));
169 s->identify_set = 1;
5391d806
FB		 170}
171
172static void ide_atapi_identify(IDEState *s)
173{
174 uint16_t *p;
175
94458802
FB		 176 if (s->identify_set) {
177 memcpy(s->io_buffer, s->identify_data, sizeof(s->identify_data));
178 return;
179 }
180
5391d806
FB		 181 memset(s->io_buffer, 0, 512);
182 p = (uint16_t *)s->io_buffer;
183 /* Removable CDROM, 50us response, 12 byte packets */
67b915a5 184 put_le16(p + 0, (2 << 14) | (5 << 8) | (1 << 7) | (2 << 5) | (0 << 0));
fa879c64 185 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */
67b915a5
FB		 186 put_le16(p + 20, 3); /* buffer type */
187 put_le16(p + 21, 512); /* cache size in sectors */
188 put_le16(p + 22, 4); /* ecc bytes */
60fe76f3 189 padstr((char *)(p + 23), QEMU_VERSION, 8); /* firmware version */
38cdea7c 190 padstr((char *)(p + 27), "QEMU DVD-ROM", 40); /* model */
67b915a5 191 put_le16(p + 48, 1); /* dword I/O (XXX: should not be set on CDROM) */
8ccad811
FB		 192#ifdef USE_DMA_CDROM
193 put_le16(p + 49, 1 << 9 | 1 << 8); /* DMA and LBA supported */
194 put_le16(p + 53, 7); /* words 64-70, 54-58, 88 valid */
d1b5c20d 195 put_le16(p + 62, 7); /* single word dma0-2 supported */
8ccad811
FB		 196 put_le16(p + 63, 7); /* mdma0-2 supported */
197 put_le16(p + 64, 0x3f); /* PIO modes supported */
198#else
67b915a5
FB		 199 put_le16(p + 49, 1 << 9); /* LBA supported, no DMA */
200 put_le16(p + 53, 3); /* words 64-70, 54-58 valid */
201 put_le16(p + 63, 0x103); /* DMA modes XXX: may be incorrect */
202 put_le16(p + 64, 1); /* PIO modes */
8ccad811 203#endif
67b915a5
FB		 204 put_le16(p + 65, 0xb4); /* minimum DMA multiword tx cycle time */
205 put_le16(p + 66, 0xb4); /* recommended DMA multiword tx cycle time */
206 put_le16(p + 67, 0x12c); /* minimum PIO cycle time without flow control */
207 put_le16(p + 68, 0xb4); /* minimum PIO cycle time with IORDY flow control */
94458802 208
67b915a5
FB		 209 put_le16(p + 71, 30); /* in ns */
210 put_le16(p + 72, 30); /* in ns */
5391d806 211
67b915a5 212 put_le16(p + 80, 0x1e); /* support up to ATA/ATAPI-4 */
8ccad811
FB		 213#ifdef USE_DMA_CDROM
214 put_le16(p + 88, 0x3f | (1 << 13)); /* udma5 set and supported */
215#endif
94458802
FB		 216 memcpy(s->identify_data, p, sizeof(s->identify_data));
217 s->identify_set = 1;
5391d806
FB		 218}
219
201a51fc
AZ		 220static void ide_cfata_identify(IDEState *s)
221{
222 uint16_t *p;
223 uint32_t cur_sec;
201a51fc
AZ		 224
225 p = (uint16_t *) s->identify_data;
226 if (s->identify_set)
227 goto fill_buffer;
228
229 memset(p, 0, sizeof(s->identify_data));
230
231 cur_sec = s->cylinders * s->heads * s->sectors;
232
233 put_le16(p + 0, 0x848a); /* CF Storage Card signature */
234 put_le16(p + 1, s->cylinders); /* Default cylinders */
235 put_le16(p + 3, s->heads); /* Default heads */
236 put_le16(p + 6, s->sectors); /* Default sectors per track */
237 put_le16(p + 7, s->nb_sectors >> 16); /* Sectors per card */
238 put_le16(p + 8, s->nb_sectors); /* Sectors per card */
fa879c64 239 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */
201a51fc 240 put_le16(p + 22, 0x0004); /* ECC bytes */
60fe76f3
TS		 241 padstr((char *) (p + 23), QEMU_VERSION, 8); /* Firmware Revision */
242 padstr((char *) (p + 27), "QEMU MICRODRIVE", 40);/* Model number */
201a51fc
AZ		 243#if MAX_MULT_SECTORS > 1
244 put_le16(p + 47, 0x8000 | MAX_MULT_SECTORS);
245#else
246 put_le16(p + 47, 0x0000);
247#endif
248 put_le16(p + 49, 0x0f00); /* Capabilities */
249 put_le16(p + 51, 0x0002); /* PIO cycle timing mode */
250 put_le16(p + 52, 0x0001); /* DMA cycle timing mode */
251 put_le16(p + 53, 0x0003); /* Translation params valid */
252 put_le16(p + 54, s->cylinders); /* Current cylinders */
253 put_le16(p + 55, s->heads); /* Current heads */
254 put_le16(p + 56, s->sectors); /* Current sectors */
255 put_le16(p + 57, cur_sec); /* Current capacity */
256 put_le16(p + 58, cur_sec >> 16); /* Current capacity */
257 if (s->mult_sectors) /* Multiple sector setting */
258 put_le16(p + 59, 0x100 | s->mult_sectors);
259 put_le16(p + 60, s->nb_sectors); /* Total LBA sectors */
260 put_le16(p + 61, s->nb_sectors >> 16); /* Total LBA sectors */
261 put_le16(p + 63, 0x0203); /* Multiword DMA capability */
262 put_le16(p + 64, 0x0001); /* Flow Control PIO support */
263 put_le16(p + 65, 0x0096); /* Min. Multiword DMA cycle */
264 put_le16(p + 66, 0x0096); /* Rec. Multiword DMA cycle */
265 put_le16(p + 68, 0x00b4); /* Min. PIO cycle time */
266 put_le16(p + 82, 0x400c); /* Command Set supported */
267 put_le16(p + 83, 0x7068); /* Command Set supported */
268 put_le16(p + 84, 0x4000); /* Features supported */
269 put_le16(p + 85, 0x000c); /* Command Set enabled */
270 put_le16(p + 86, 0x7044); /* Command Set enabled */
271 put_le16(p + 87, 0x4000); /* Features enabled */
272 put_le16(p + 91, 0x4060); /* Current APM level */
273 put_le16(p + 129, 0x0002); /* Current features option */
274 put_le16(p + 130, 0x0005); /* Reassigned sectors */
275 put_le16(p + 131, 0x0001); /* Initial power mode */
276 put_le16(p + 132, 0x0000); /* User signature */
277 put_le16(p + 160, 0x8100); /* Power requirement */
278 put_le16(p + 161, 0x8001); /* CF command set */
279
280 s->identify_set = 1;
281
282fill_buffer:
283 memcpy(s->io_buffer, p, sizeof(s->identify_data));
284}
285
5391d806
FB		 286static void ide_set_signature(IDEState *s)
287{
288 s->select &= 0xf0; /* clear head */
289 /* put signature */
290 s->nsector = 1;
291 s->sector = 1;
292 if (s->is_cdrom) {
293 s->lcyl = 0x14;
294 s->hcyl = 0xeb;
295 } else if (s->bs) {
296 s->lcyl = 0;
297 s->hcyl = 0;
298 } else {
299 s->lcyl = 0xff;
300 s->hcyl = 0xff;
301 }
302}
303
304static inline void ide_abort_command(IDEState *s)
305{
306 s->status = READY_STAT | ERR_STAT;
307 s->error = ABRT_ERR;
308}
309
5604e090
AZ		 310static inline void ide_dma_submit_check(IDEState *s,
311 BlockDriverCompletionFunc *dma_cb, BMDMAState *bm)
312{
313 if (bm->aiocb)
314 return;
315 dma_cb(bm, -1);
316}
317
5391d806 318/* prepare data transfer and tell what to do after */
5fafdf24 319static void ide_transfer_start(IDEState *s, uint8_t *buf, int size,
5391d806
FB		 320 EndTransferFunc *end_transfer_func)
321{
322 s->end_transfer_func = end_transfer_func;
323 s->data_ptr = buf;
324 s->data_end = buf + size;
7603d156
TS		 325 if (!(s->status & ERR_STAT))
326 s->status |= DRQ_STAT;
5391d806
FB		 327}
328
329static void ide_transfer_stop(IDEState *s)
330{
331 s->end_transfer_func = ide_transfer_stop;
332 s->data_ptr = s->io_buffer;
333 s->data_end = s->io_buffer;
334 s->status &= ~DRQ_STAT;
335}
336
356721ae 337int64_t ide_get_sector(IDEState *s)
5391d806
FB		 338{
339 int64_t sector_num;
340 if (s->select & 0x40) {
341 /* lba */
c2ff060f
FB		 342 if (!s->lba48) {
343 sector_num = ((s->select & 0x0f) << 24) | (s->hcyl << 16) |
344 (s->lcyl << 8) | s->sector;
345 } else {
346 sector_num = ((int64_t)s->hob_hcyl << 40) |
347 ((int64_t) s->hob_lcyl << 32) |
348 ((int64_t) s->hob_sector << 24) |
349 ((int64_t) s->hcyl << 16) |
350 ((int64_t) s->lcyl << 8) | s->sector;
351 }
5391d806
FB		 352 } else {
353 sector_num = ((s->hcyl << 8) | s->lcyl) * s->heads * s->sectors +
c2ff060f 354 (s->select & 0x0f) * s->sectors + (s->sector - 1);
5391d806
FB		 355 }
356 return sector_num;
357}
358
356721ae 359void ide_set_sector(IDEState *s, int64_t sector_num)
5391d806
FB		 360{
361 unsigned int cyl, r;
362 if (s->select & 0x40) {
c2ff060f
FB		 363 if (!s->lba48) {
364 s->select = (s->select & 0xf0) | (sector_num >> 24);
365 s->hcyl = (sector_num >> 16);
366 s->lcyl = (sector_num >> 8);
367 s->sector = (sector_num);
368 } else {
369 s->sector = sector_num;
370 s->lcyl = sector_num >> 8;
371 s->hcyl = sector_num >> 16;
372 s->hob_sector = sector_num >> 24;
373 s->hob_lcyl = sector_num >> 32;
374 s->hob_hcyl = sector_num >> 40;
375 }
5391d806
FB		 376 } else {
377 cyl = sector_num / (s->heads * s->sectors);
378 r = sector_num % (s->heads * s->sectors);
379 s->hcyl = cyl >> 8;
380 s->lcyl = cyl;
1b8eb456 381 s->select = (s->select & 0xf0) | ((r / s->sectors) & 0x0f);
5391d806
FB		 382 s->sector = (r % s->sectors) + 1;
383 }
384}
385
e162cfb0
AZ		 386static void ide_rw_error(IDEState *s) {
387 ide_abort_command(s);
9cdd03a7 388 ide_set_irq(s->bus);
e162cfb0
AZ		 389}
390
5391d806
FB		 391static void ide_sector_read(IDEState *s)
392{
393 int64_t sector_num;
394 int ret, n;
395
396 s->status = READY_STAT | SEEK_STAT;
a136e5a8 397 s->error = 0; /* not needed by IDE spec, but needed by Windows */
5391d806
FB		 398 sector_num = ide_get_sector(s);
399 n = s->nsector;
400 if (n == 0) {
401 /* no more sector to read from disk */
402 ide_transfer_stop(s);
403 } else {
404#if defined(DEBUG_IDE)
18c5f8ea 405 printf("read sector=%" PRId64 "\n", sector_num);
5391d806
FB		 406#endif
407 if (n > s->req_nb_sectors)
408 n = s->req_nb_sectors;
409 ret = bdrv_read(s->bs, sector_num, s->io_buffer, n);
e162cfb0 410 if (ret != 0) {
ce4b6522
KW		 411 if (ide_handle_rw_error(s, -ret,
412 BM_STATUS_PIO_RETRY | BM_STATUS_RETRY_READ))
413 {
414 return;
415 }
e162cfb0 416 }
5391d806 417 ide_transfer_start(s, s->io_buffer, 512 * n, ide_sector_read);
9cdd03a7 418 ide_set_irq(s->bus);
5391d806
FB		 419 ide_set_sector(s, sector_num + n);
420 s->nsector -= n;
421 }
422}
423
7aea4412
AL		 424
425/* return 0 if buffer completed */
426static int dma_buf_prepare(BMDMAState *bm, int is_write)
427{
bcbdc4d3 428 IDEState *s = bmdma_active_if(bm);
7aea4412
AL		 429 struct {
430 uint32_t addr;
431 uint32_t size;
432 } prd;
433 int l, len;
7aea4412 434
1fb8648d 435 qemu_sglist_init(&s->sg, s->nsector / (TARGET_PAGE_SIZE/512) + 1);
7aea4412
AL		 436 s->io_buffer_size = 0;
437 for(;;) {
438 if (bm->cur_prd_len == 0) {
439 /* end of table (with a fail safe of one page) */
440 if (bm->cur_prd_last ||
441 (bm->cur_addr - bm->addr) >= 4096)
442 return s->io_buffer_size != 0;
443 cpu_physical_memory_read(bm->cur_addr, (uint8_t *)&prd, 8);
444 bm->cur_addr += 8;
445 prd.addr = le32_to_cpu(prd.addr);
446 prd.size = le32_to_cpu(prd.size);
447 len = prd.size & 0xfffe;
448 if (len == 0)
449 len = 0x10000;
450 bm->cur_prd_len = len;
451 bm->cur_prd_addr = prd.addr;
452 bm->cur_prd_last = (prd.size & 0x80000000);
453 }
454 l = bm->cur_prd_len;
455 if (l > 0) {
1fb8648d
AL		 456 qemu_sglist_add(&s->sg, bm->cur_prd_addr, l);
457 bm->cur_prd_addr += l;
458 bm->cur_prd_len -= l;
459 s->io_buffer_size += l;
7aea4412
AL		 460 }
461 }
462 return 1;
463}
464
465static void dma_buf_commit(IDEState *s, int is_write)
466{
1fb8648d 467 qemu_sglist_destroy(&s->sg);
7aea4412
AL		 468}
469
356721ae 470void ide_dma_error(IDEState *s)
e162cfb0
AZ		 471{
472 ide_transfer_stop(s);
473 s->error = ABRT_ERR;
474 s->status = READY_STAT | ERR_STAT;
9cdd03a7 475 ide_set_irq(s->bus);
e162cfb0
AZ		 476}
477
ce4b6522 478static int ide_handle_rw_error(IDEState *s, int error, int op)
428c5705 479{
ce4b6522
KW		 480 int is_read = (op & BM_STATUS_RETRY_READ);
481 BlockInterfaceErrorAction action = drive_get_on_error(s->bs, is_read);
428c5705
AL		 482
483 if (action == BLOCK_ERR_IGNORE)
484 return 0;
485
486 if ((error == ENOSPC && action == BLOCK_ERR_STOP_ENOSPC)
487 || action == BLOCK_ERR_STOP_ANY) {
bcbdc4d3
GH		 488 s->bus->bmdma->unit = s->unit;
489 s->bus->bmdma->status |= op;
428c5705
AL		 490 vm_stop(0);
491 } else {
ce4b6522 492 if (op & BM_STATUS_DMA_RETRY) {
7aea4412 493 dma_buf_commit(s, 0);
428c5705 494 ide_dma_error(s);
7aea4412 495 } else {
428c5705 496 ide_rw_error(s);
7aea4412 497 }
428c5705
AL		 498 }
499
500 return 1;
501}
502
8ccad811
FB		 503/* return 0 if buffer completed */
504static int dma_buf_rw(BMDMAState *bm, int is_write)
98087450 505{
bcbdc4d3 506 IDEState *s = bmdma_active_if(bm);
8ccad811
FB		 507 struct {
508 uint32_t addr;
509 uint32_t size;
510 } prd;
511 int l, len;
98087450 512
8ccad811
FB		 513 for(;;) {
514 l = s->io_buffer_size - s->io_buffer_index;
5fafdf24 515 if (l <= 0)
8ccad811
FB		 516 break;
517 if (bm->cur_prd_len == 0) {
518 /* end of table (with a fail safe of one page) */
519 if (bm->cur_prd_last ||
520 (bm->cur_addr - bm->addr) >= 4096)
521 return 0;
522 cpu_physical_memory_read(bm->cur_addr, (uint8_t *)&prd, 8);
523 bm->cur_addr += 8;
524 prd.addr = le32_to_cpu(prd.addr);
525 prd.size = le32_to_cpu(prd.size);
526 len = prd.size & 0xfffe;
527 if (len == 0)
528 len = 0x10000;
529 bm->cur_prd_len = len;
530 bm->cur_prd_addr = prd.addr;
531 bm->cur_prd_last = (prd.size & 0x80000000);
532 }
533 if (l > bm->cur_prd_len)
534 l = bm->cur_prd_len;
535 if (l > 0) {
536 if (is_write) {
5fafdf24 537 cpu_physical_memory_write(bm->cur_prd_addr,
8ccad811
FB		 538 s->io_buffer + s->io_buffer_index, l);
539 } else {
5fafdf24 540 cpu_physical_memory_read(bm->cur_prd_addr,
8ccad811
FB		 541 s->io_buffer + s->io_buffer_index, l);
542 }
543 bm->cur_prd_addr += l;
544 bm->cur_prd_len -= l;
545 s->io_buffer_index += l;
98087450 546 }
98087450 547 }
8ccad811
FB		 548 return 1;
549}
550
8ccad811
FB		 551static void ide_read_dma_cb(void *opaque, int ret)
552{
553 BMDMAState *bm = opaque;
bcbdc4d3 554 IDEState *s = bmdma_active_if(bm);
8ccad811
FB		 555 int n;
556 int64_t sector_num;
557
e162cfb0 558 if (ret < 0) {
ce4b6522
KW		 559 if (ide_handle_rw_error(s, -ret,
560 BM_STATUS_DMA_RETRY | BM_STATUS_RETRY_READ))
561 {
562 return;
563 }
e162cfb0
AZ		 564 }
565
8ccad811
FB		 566 n = s->io_buffer_size >> 9;
567 sector_num = ide_get_sector(s);
568 if (n > 0) {
7aea4412 569 dma_buf_commit(s, 1);
8ccad811
FB		 570 sector_num += n;
571 ide_set_sector(s, sector_num);
572 s->nsector -= n;
8ccad811
FB		 573 }
574
575 /* end of transfer ? */
576 if (s->nsector == 0) {
98087450 577 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 578 ide_set_irq(s->bus);
8ccad811
FB		 579 eot:
580 bm->status &= ~BM_STATUS_DMAING;
581 bm->status |= BM_STATUS_INT;
582 bm->dma_cb = NULL;
bcbdc4d3 583 bm->unit = -1;
8ccad811
FB		 584 bm->aiocb = NULL;
585 return;
98087450 586 }
8ccad811
FB		 587
588 /* launch next transfer */
589 n = s->nsector;
8ccad811
FB		 590 s->io_buffer_index = 0;
591 s->io_buffer_size = n * 512;
7aea4412
AL		 592 if (dma_buf_prepare(bm, 1) == 0)
593 goto eot;
8ccad811 594#ifdef DEBUG_AIO
5df23f53 595 printf("aio_read: sector_num=%" PRId64 " n=%d\n", sector_num, n);
8ccad811 596#endif
1fb8648d 597 bm->aiocb = dma_bdrv_read(s->bs, &s->sg, sector_num, ide_read_dma_cb, bm);
5604e090 598 ide_dma_submit_check(s, ide_read_dma_cb, bm);
98087450
FB		 599}
600
601static void ide_sector_read_dma(IDEState *s)
602{
8ccad811 603 s->status = READY_STAT | SEEK_STAT | DRQ_STAT | BUSY_STAT;
98087450
FB		 604 s->io_buffer_index = 0;
605 s->io_buffer_size = 0;
e3007e66 606 s->is_read = 1;
98087450
FB		 607 ide_dma_start(s, ide_read_dma_cb);
608}
609
a09db21f
FB		 610static void ide_sector_write_timer_cb(void *opaque)
611{
612 IDEState *s = opaque;
9cdd03a7 613 ide_set_irq(s->bus);
a09db21f
FB		 614}
615
5391d806
FB		 616static void ide_sector_write(IDEState *s)
617{
618 int64_t sector_num;
31c2a146 619 int ret, n, n1;
5391d806
FB		 620
621 s->status = READY_STAT | SEEK_STAT;
622 sector_num = ide_get_sector(s);
623#if defined(DEBUG_IDE)
18c5f8ea 624 printf("write sector=%" PRId64 "\n", sector_num);
5391d806
FB		 625#endif
626 n = s->nsector;
627 if (n > s->req_nb_sectors)
628 n = s->req_nb_sectors;
31c2a146 629 ret = bdrv_write(s->bs, sector_num, s->io_buffer, n);
428c5705 630
e162cfb0 631 if (ret != 0) {
ce4b6522 632 if (ide_handle_rw_error(s, -ret, BM_STATUS_PIO_RETRY))
428c5705 633 return;
e162cfb0
AZ		 634 }
635
5391d806
FB		 636 s->nsector -= n;
637 if (s->nsector == 0) {
292eef5a 638 /* no more sectors to write */
5391d806
FB		 639 ide_transfer_stop(s);
640 } else {
641 n1 = s->nsector;
642 if (n1 > s->req_nb_sectors)
643 n1 = s->req_nb_sectors;
644 ide_transfer_start(s, s->io_buffer, 512 * n1, ide_sector_write);
645 }
646 ide_set_sector(s, sector_num + n);
3b46e624 647
31c2a146
TS		 648#ifdef TARGET_I386
649 if (win2k_install_hack && ((++s->irq_count % 16) == 0)) {
650 /* It seems there is a bug in the Windows 2000 installer HDD
651 IDE driver which fills the disk with empty logs when the
652 IDE write IRQ comes too early. This hack tries to correct
653 that at the expense of slower write performances. Use this
654 option _only_ to install Windows 2000. You must disable it
655 for normal use. */
656 qemu_mod_timer(s->sector_write_timer,
6ee093c9 657 qemu_get_clock(vm_clock) + (get_ticks_per_sec() / 1000));
31c2a146
TS		 658 } else
659#endif
660 {
9cdd03a7 661 ide_set_irq(s->bus);
31c2a146 662 }
5391d806
FB		 663}
664
213189ab 665static void ide_dma_restart_bh(void *opaque)
428c5705
AL		 666{
667 BMDMAState *bm = opaque;
ce4b6522 668 int is_read;
213189ab
MA		 669
670 qemu_bh_delete(bm->bh);
671 bm->bh = NULL;
672
ce4b6522
KW		 673 is_read = !!(bm->status & BM_STATUS_RETRY_READ);
674
428c5705 675 if (bm->status & BM_STATUS_DMA_RETRY) {
ce4b6522
KW		 676 bm->status &= ~(BM_STATUS_DMA_RETRY | BM_STATUS_RETRY_READ);
677 ide_dma_restart(bmdma_active_if(bm), is_read);
428c5705 678 } else if (bm->status & BM_STATUS_PIO_RETRY) {
ce4b6522
KW		 679 bm->status &= ~(BM_STATUS_PIO_RETRY | BM_STATUS_RETRY_READ);
680 if (is_read) {
681 ide_sector_read(bmdma_active_if(bm));
682 } else {
683 ide_sector_write(bmdma_active_if(bm));
684 }
428c5705
AL		 685 }
686}
687
356721ae 688void ide_dma_restart_cb(void *opaque, int running, int reason)
213189ab
MA		 689{
690 BMDMAState *bm = opaque;
691
692 if (!running)
693 return;
694
695 if (!bm->bh) {
696 bm->bh = qemu_bh_new(ide_dma_restart_bh, bm);
697 qemu_bh_schedule(bm->bh);
698 }
699}
700
8ccad811 701static void ide_write_dma_cb(void *opaque, int ret)
98087450 702{
8ccad811 703 BMDMAState *bm = opaque;
bcbdc4d3 704 IDEState *s = bmdma_active_if(bm);
8ccad811 705 int n;
98087450
FB		 706 int64_t sector_num;
707
e162cfb0 708 if (ret < 0) {
ce4b6522 709 if (ide_handle_rw_error(s, -ret, BM_STATUS_DMA_RETRY))
428c5705 710 return;
e162cfb0
AZ		 711 }
712
8ccad811
FB		 713 n = s->io_buffer_size >> 9;
714 sector_num = ide_get_sector(s);
715 if (n > 0) {
7aea4412 716 dma_buf_commit(s, 0);
8ccad811
FB		 717 sector_num += n;
718 ide_set_sector(s, sector_num);
719 s->nsector -= n;
98087450 720 }
98087450 721
8ccad811
FB		 722 /* end of transfer ? */
723 if (s->nsector == 0) {
724 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 725 ide_set_irq(s->bus);
8ccad811
FB		 726 eot:
727 bm->status &= ~BM_STATUS_DMAING;
728 bm->status |= BM_STATUS_INT;
729 bm->dma_cb = NULL;
bcbdc4d3 730 bm->unit = -1;
8ccad811
FB		 731 bm->aiocb = NULL;
732 return;
733 }
734
98087450 735 n = s->nsector;
98087450 736 s->io_buffer_size = n * 512;
7aea4412
AL		 737 /* launch next transfer */
738 if (dma_buf_prepare(bm, 0) == 0)
8ccad811
FB		 739 goto eot;
740#ifdef DEBUG_AIO
5df23f53 741 printf("aio_write: sector_num=%" PRId64 " n=%d\n", sector_num, n);
8ccad811 742#endif
1fb8648d 743 bm->aiocb = dma_bdrv_write(s->bs, &s->sg, sector_num, ide_write_dma_cb, bm);
5604e090 744 ide_dma_submit_check(s, ide_write_dma_cb, bm);
8ccad811
FB		 745}
746
747static void ide_sector_write_dma(IDEState *s)
748{
749 s->status = READY_STAT | SEEK_STAT | DRQ_STAT | BUSY_STAT;
750 s->io_buffer_index = 0;
751 s->io_buffer_size = 0;
e3007e66 752 s->is_read = 0;
98087450
FB		 753 ide_dma_start(s, ide_write_dma_cb);
754}
755
356721ae 756void ide_atapi_cmd_ok(IDEState *s)
5391d806
FB		 757{
758 s->error = 0;
41a2b959 759 s->status = READY_STAT | SEEK_STAT;
5391d806 760 s->nsector = (s->nsector & ~7) | ATAPI_INT_REASON_IO | ATAPI_INT_REASON_CD;
9cdd03a7 761 ide_set_irq(s->bus);
5391d806
FB		 762}
763
356721ae 764void ide_atapi_cmd_error(IDEState *s, int sense_key, int asc)
5391d806
FB		 765{
766#ifdef DEBUG_IDE_ATAPI
767 printf("atapi_cmd_error: sense=0x%x asc=0x%x\n", sense_key, asc);
768#endif
769 s->error = sense_key << 4;
770 s->status = READY_STAT | ERR_STAT;
771 s->nsector = (s->nsector & ~7) | ATAPI_INT_REASON_IO | ATAPI_INT_REASON_CD;
772 s->sense_key = sense_key;
773 s->asc = asc;
9cdd03a7 774 ide_set_irq(s->bus);
5391d806
FB		 775}
776
9118e7f0
AL		 777static void ide_atapi_cmd_check_status(IDEState *s)
778{
779#ifdef DEBUG_IDE_ATAPI
780 printf("atapi_cmd_check_status\n");
781#endif
782 s->error = MC_ERR | (SENSE_UNIT_ATTENTION << 4);
783 s->status = ERR_STAT;
784 s->nsector = 0;
9cdd03a7 785 ide_set_irq(s->bus);
9118e7f0
AL		 786}
787
b0484ae4
CH		 788static void ide_flush_cb(void *opaque, int ret)
789{
790 IDEState *s = opaque;
791
792 /* XXX: how do we signal I/O errors here? */
793
794 s->status = READY_STAT | SEEK_STAT;
795 ide_set_irq(s->bus);
796}
797
5391d806
FB		 798static inline void cpu_to_ube16(uint8_t *buf, int val)
799{
800 buf[0] = val >> 8;
9e622b15 801 buf[1] = val & 0xff;
5391d806
FB		 802}
803
804static inline void cpu_to_ube32(uint8_t *buf, unsigned int val)
805{
806 buf[0] = val >> 24;
807 buf[1] = val >> 16;
808 buf[2] = val >> 8;
9e622b15 809 buf[3] = val & 0xff;
5391d806
FB		 810}
811
812static inline int ube16_to_cpu(const uint8_t *buf)
813{
814 return (buf[0] << 8) | buf[1];
815}
816
817static inline int ube32_to_cpu(const uint8_t *buf)
818{
819 return (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
820}
821
98087450
FB		 822static void lba_to_msf(uint8_t *buf, int lba)
823{
824 lba += 150;
825 buf[0] = (lba / 75) / 60;
826 buf[1] = (lba / 75) % 60;
827 buf[2] = lba % 75;
828}
829
8ccad811
FB		 830static void cd_data_to_raw(uint8_t *buf, int lba)
831{
832 /* sync bytes */
833 buf[0] = 0x00;
834 memset(buf + 1, 0xff, 10);
835 buf[11] = 0x00;
836 buf += 12;
837 /* MSF */
838 lba_to_msf(buf, lba);
839 buf[3] = 0x01; /* mode 1 data */
840 buf += 4;
841 /* data */
842 buf += 2048;
843 /* XXX: ECC not computed */
844 memset(buf, 0, 288);
845}
846
5fafdf24 847static int cd_read_sector(BlockDriverState *bs, int lba, uint8_t *buf,
98087450
FB		 848 int sector_size)
849{
66c6ef76
FB		 850 int ret;
851
98087450
FB		 852 switch(sector_size) {
853 case 2048:
66c6ef76 854 ret = bdrv_read(bs, (int64_t)lba << 2, buf, 4);
98087450
FB		 855 break;
856 case 2352:
66c6ef76
FB		 857 ret = bdrv_read(bs, (int64_t)lba << 2, buf + 16, 4);
858 if (ret < 0)
859 return ret;
8ccad811 860 cd_data_to_raw(buf, lba);
98087450
FB		 861 break;
862 default:
66c6ef76 863 ret = -EIO;
98087450
FB		 864 break;
865 }
66c6ef76
FB		 866 return ret;
867}
868
356721ae 869void ide_atapi_io_error(IDEState *s, int ret)
66c6ef76
FB		 870{
871 /* XXX: handle more errors */
872 if (ret == -ENOMEDIUM) {
5fafdf24 873 ide_atapi_cmd_error(s, SENSE_NOT_READY,
66c6ef76
FB		 874 ASC_MEDIUM_NOT_PRESENT);
875 } else {
5fafdf24 876 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
66c6ef76
FB		 877 ASC_LOGICAL_BLOCK_OOR);
878 }
98087450
FB		 879}
880
5391d806
FB		 881/* The whole ATAPI transfer logic is handled in this function */
882static void ide_atapi_cmd_reply_end(IDEState *s)
883{
66c6ef76 884 int byte_count_limit, size, ret;
5391d806 885#ifdef DEBUG_IDE_ATAPI
5fafdf24 886 printf("reply: tx_size=%d elem_tx_size=%d index=%d\n",
5391d806
FB		 887 s->packet_transfer_size,
888 s->elementary_transfer_size,
889 s->io_buffer_index);
890#endif
891 if (s->packet_transfer_size <= 0) {
892 /* end of transfer */
893 ide_transfer_stop(s);
41a2b959 894 s->status = READY_STAT | SEEK_STAT;
5391d806 895 s->nsector = (s->nsector & ~7) | ATAPI_INT_REASON_IO | ATAPI_INT_REASON_CD;
9cdd03a7 896 ide_set_irq(s->bus);
5391d806
FB		 897#ifdef DEBUG_IDE_ATAPI
898 printf("status=0x%x\n", s->status);
899#endif
900 } else {
901 /* see if a new sector must be read */
98087450 902 if (s->lba != -1 && s->io_buffer_index >= s->cd_sector_size) {
66c6ef76
FB		 903 ret = cd_read_sector(s->bs, s->lba, s->io_buffer, s->cd_sector_size);
904 if (ret < 0) {
905 ide_transfer_stop(s);
906 ide_atapi_io_error(s, ret);
907 return;
908 }
5391d806
FB		 909 s->lba++;
910 s->io_buffer_index = 0;
911 }
912 if (s->elementary_transfer_size > 0) {
913 /* there are some data left to transmit in this elementary
914 transfer */
98087450 915 size = s->cd_sector_size - s->io_buffer_index;
5391d806
FB		 916 if (size > s->elementary_transfer_size)
917 size = s->elementary_transfer_size;
5fafdf24 918 ide_transfer_start(s, s->io_buffer + s->io_buffer_index,
5391d806
FB		 919 size, ide_atapi_cmd_reply_end);
920 s->packet_transfer_size -= size;
921 s->elementary_transfer_size -= size;
922 s->io_buffer_index += size;
923 } else {
924 /* a new transfer is needed */
925 s->nsector = (s->nsector & ~7) | ATAPI_INT_REASON_IO;
926 byte_count_limit = s->lcyl | (s->hcyl << 8);
927#ifdef DEBUG_IDE_ATAPI
928 printf("byte_count_limit=%d\n", byte_count_limit);
929#endif
930 if (byte_count_limit == 0xffff)
931 byte_count_limit--;
932 size = s->packet_transfer_size;
933 if (size > byte_count_limit) {
934 /* byte count limit must be even if this case */
935 if (byte_count_limit & 1)
936 byte_count_limit--;
937 size = byte_count_limit;
5391d806 938 }
a136e5a8
FB		 939 s->lcyl = size;
940 s->hcyl = size >> 8;
5391d806
FB		 941 s->elementary_transfer_size = size;
942 /* we cannot transmit more than one sector at a time */
943 if (s->lba != -1) {
98087450
FB		 944 if (size > (s->cd_sector_size - s->io_buffer_index))
945 size = (s->cd_sector_size - s->io_buffer_index);
5391d806 946 }
5fafdf24 947 ide_transfer_start(s, s->io_buffer + s->io_buffer_index,
5391d806
FB		 948 size, ide_atapi_cmd_reply_end);
949 s->packet_transfer_size -= size;
950 s->elementary_transfer_size -= size;
951 s->io_buffer_index += size;
9cdd03a7 952 ide_set_irq(s->bus);
5391d806
FB		 953#ifdef DEBUG_IDE_ATAPI
954 printf("status=0x%x\n", s->status);
955#endif
956 }
957 }
958}
959
960/* send a reply of 'size' bytes in s->io_buffer to an ATAPI command */
961static void ide_atapi_cmd_reply(IDEState *s, int size, int max_size)
962{
963 if (size > max_size)
964 size = max_size;
965 s->lba = -1; /* no sector read */
966 s->packet_transfer_size = size;
5f12ab4b 967 s->io_buffer_size = size; /* dma: send the reply data as one chunk */
5391d806
FB		 968 s->elementary_transfer_size = 0;
969 s->io_buffer_index = 0;
970
5f12ab4b 971 if (s->atapi_dma) {
41a2b959 972 s->status = READY_STAT | SEEK_STAT | DRQ_STAT;
5f12ab4b
TS		 973 ide_dma_start(s, ide_atapi_cmd_read_dma_cb);
974 } else {
41a2b959 975 s->status = READY_STAT | SEEK_STAT;
5f12ab4b
TS		 976 ide_atapi_cmd_reply_end(s);
977 }
5391d806
FB		 978}
979
980/* start a CD-CDROM read command */
98087450
FB		 981static void ide_atapi_cmd_read_pio(IDEState *s, int lba, int nb_sectors,
982 int sector_size)
5391d806 983{
5391d806 984 s->lba = lba;
98087450 985 s->packet_transfer_size = nb_sectors * sector_size;
5391d806 986 s->elementary_transfer_size = 0;
98087450
FB		 987 s->io_buffer_index = sector_size;
988 s->cd_sector_size = sector_size;
5391d806 989
41a2b959 990 s->status = READY_STAT | SEEK_STAT;
5391d806
FB		 991 ide_atapi_cmd_reply_end(s);
992}
993
98087450 994/* ATAPI DMA support */
8ccad811
FB		 995
996/* XXX: handle read errors */
997static void ide_atapi_cmd_read_dma_cb(void *opaque, int ret)
98087450 998{
8ccad811 999 BMDMAState *bm = opaque;
bcbdc4d3 1000 IDEState *s = bmdma_active_if(bm);
8ccad811
FB		 1001 int data_offset, n;
1002
66c6ef76
FB		 1003 if (ret < 0) {
1004 ide_atapi_io_error(s, ret);
1005 goto eot;
1006 }
1007
8ccad811 1008 if (s->io_buffer_size > 0) {
5f12ab4b
TS		 1009 /*
1010 * For a cdrom read sector command (s->lba != -1),
1011 * adjust the lba for the next s->io_buffer_size chunk
1012 * and dma the current chunk.
1013 * For a command != read (s->lba == -1), just transfer
1014 * the reply data.
1015 */
1016 if (s->lba != -1) {
1017 if (s->cd_sector_size == 2352) {
1018 n = 1;
1019 cd_data_to_raw(s->io_buffer, s->lba);
1020 } else {
1021 n = s->io_buffer_size >> 11;
1022 }
1023 s->lba += n;
1024 }
8ccad811 1025 s->packet_transfer_size -= s->io_buffer_size;
8ccad811
FB		 1026 if (dma_buf_rw(bm, 1) == 0)
1027 goto eot;
98087450 1028 }
8ccad811 1029
98087450 1030 if (s->packet_transfer_size <= 0) {
41a2b959 1031 s->status = READY_STAT | SEEK_STAT;
98087450 1032 s->nsector = (s->nsector & ~7) | ATAPI_INT_REASON_IO | ATAPI_INT_REASON_CD;
9cdd03a7 1033 ide_set_irq(s->bus);
8ccad811
FB		 1034 eot:
1035 bm->status &= ~BM_STATUS_DMAING;
1036 bm->status |= BM_STATUS_INT;
1037 bm->dma_cb = NULL;
bcbdc4d3 1038 bm->unit = -1;
8ccad811
FB		 1039 bm->aiocb = NULL;
1040 return;
1041 }
3b46e624 1042
8ccad811
FB		 1043 s->io_buffer_index = 0;
1044 if (s->cd_sector_size == 2352) {
1045 n = 1;
1046 s->io_buffer_size = s->cd_sector_size;
1047 data_offset = 16;
1048 } else {
1049 n = s->packet_transfer_size >> 11;
1d8cde5b
AJ		 1050 if (n > (IDE_DMA_BUF_SECTORS / 4))
1051 n = (IDE_DMA_BUF_SECTORS / 4);
8ccad811
FB		 1052 s->io_buffer_size = n * 2048;
1053 data_offset = 0;
98087450 1054 }
8ccad811
FB		 1055#ifdef DEBUG_AIO
1056 printf("aio_read_cd: lba=%u n=%d\n", s->lba, n);
1057#endif
3f4cb3d3 1058 bm->iov.iov_base = (void *)(s->io_buffer + data_offset);
c87c0672
AL		 1059 bm->iov.iov_len = n * 4 * 512;
1060 qemu_iovec_init_external(&bm->qiov, &bm->iov, 1);
1061 bm->aiocb = bdrv_aio_readv(s->bs, (int64_t)s->lba << 2, &bm->qiov,
1062 n * 4, ide_atapi_cmd_read_dma_cb, bm);
66c6ef76
FB		 1063 if (!bm->aiocb) {
1064 /* Note: media not present is the most likely case */
5fafdf24 1065 ide_atapi_cmd_error(s, SENSE_NOT_READY,
66c6ef76
FB		 1066 ASC_MEDIUM_NOT_PRESENT);
1067 goto eot;
1068 }
98087450
FB		 1069}
1070
1071/* start a CD-CDROM read command with DMA */
1072/* XXX: test if DMA is available */
1073static void ide_atapi_cmd_read_dma(IDEState *s, int lba, int nb_sectors,
1074 int sector_size)
1075{
1076 s->lba = lba;
1077 s->packet_transfer_size = nb_sectors * sector_size;
8ccad811
FB		 1078 s->io_buffer_index = 0;
1079 s->io_buffer_size = 0;
98087450
FB		 1080 s->cd_sector_size = sector_size;
1081
8ccad811 1082 /* XXX: check if BUSY_STAT should be set */
41a2b959 1083 s->status = READY_STAT | SEEK_STAT | DRQ_STAT | BUSY_STAT;
98087450
FB		 1084 ide_dma_start(s, ide_atapi_cmd_read_dma_cb);
1085}
1086
5fafdf24 1087static void ide_atapi_cmd_read(IDEState *s, int lba, int nb_sectors,
98087450
FB		 1088 int sector_size)
1089{
1090#ifdef DEBUG_IDE_ATAPI
5f12ab4b
TS		 1091 printf("read %s: LBA=%d nb_sectors=%d\n", s->atapi_dma ? "dma" : "pio",
1092 lba, nb_sectors);
98087450
FB		 1093#endif
1094 if (s->atapi_dma) {
1095 ide_atapi_cmd_read_dma(s, lba, nb_sectors, sector_size);
1096 } else {
1097 ide_atapi_cmd_read_pio(s, lba, nb_sectors, sector_size);
1098 }
1099}
1100
38cdea7c
AZ		 1101static inline uint8_t ide_atapi_set_profile(uint8_t *buf, uint8_t *index,
1102 uint16_t profile)
1103{
1104 uint8_t *buf_profile = buf + 12; /* start of profiles */
1105
1106 buf_profile += ((*index) * 4); /* start of indexed profile */
1107 cpu_to_ube16 (buf_profile, profile);
1108 buf_profile[2] = ((buf_profile[0] == buf[6]) && (buf_profile[1] == buf[7]));
1109
1110 /* each profile adds 4 bytes to the response */
1111 (*index)++;
1112 buf[11] += 4; /* Additional Length */
1113
1114 return 4;
1115}
1116
8114e9e8
TS		 1117static int ide_dvd_read_structure(IDEState *s, int format,
1118 const uint8_t *packet, uint8_t *buf)
1119{
1120 switch (format) {
1121 case 0x0: /* Physical format information */
1122 {
1123 int layer = packet[6];
1124 uint64_t total_sectors;
1125
1126 if (layer != 0)
1127 return -ASC_INV_FIELD_IN_CMD_PACKET;
1128
1129 bdrv_get_geometry(s->bs, &total_sectors);
1130 total_sectors >>= 2;
1131 if (total_sectors == 0)
1132 return -ASC_MEDIUM_NOT_PRESENT;
1133
1134 buf[4] = 1; /* DVD-ROM, part version 1 */
1135 buf[5] = 0xf; /* 120mm disc, minimum rate unspecified */
1136 buf[6] = 1; /* one layer, read-only (per MMC-2 spec) */
1137 buf[7] = 0; /* default densities */
1138
1139 /* FIXME: 0x30000 per spec? */
1140 cpu_to_ube32(buf + 8, 0); /* start sector */
1141 cpu_to_ube32(buf + 12, total_sectors - 1); /* end sector */
1142 cpu_to_ube32(buf + 16, total_sectors - 1); /* l0 end sector */
1143
1144 /* Size of buffer, not including 2 byte size field */
1145 cpu_to_be16wu((uint16_t *)buf, 2048 + 2);
1146
1147 /* 2k data + 4 byte header */
1148 return (2048 + 4);
1149 }
1150
1151 case 0x01: /* DVD copyright information */
1152 buf[4] = 0; /* no copyright data */
1153 buf[5] = 0; /* no region restrictions */
1154
1155 /* Size of buffer, not including 2 byte size field */
1156 cpu_to_be16wu((uint16_t *)buf, 4 + 2);
1157
1158 /* 4 byte header + 4 byte data */
1159 return (4 + 4);
1160
1161 case 0x03: /* BCA information - invalid field for no BCA info */
1162 return -ASC_INV_FIELD_IN_CMD_PACKET;
1163
1164 case 0x04: /* DVD disc manufacturing information */
1165 /* Size of buffer, not including 2 byte size field */
1166 cpu_to_be16wu((uint16_t *)buf, 2048 + 2);
1167
1168 /* 2k data + 4 byte header */
1169 return (2048 + 4);
1170
1171 case 0xff:
1172 /*
1173 * This lists all the command capabilities above. Add new ones
1174 * in order and update the length and buffer return values.
1175 */
1176
1177 buf[4] = 0x00; /* Physical format */
1178 buf[5] = 0x40; /* Not writable, is readable */
1179 cpu_to_be16wu((uint16_t *)(buf + 6), 2048 + 4);
1180
1181 buf[8] = 0x01; /* Copyright info */
1182 buf[9] = 0x40; /* Not writable, is readable */
1183 cpu_to_be16wu((uint16_t *)(buf + 10), 4 + 4);
1184
1185 buf[12] = 0x03; /* BCA info */
1186 buf[13] = 0x40; /* Not writable, is readable */
1187 cpu_to_be16wu((uint16_t *)(buf + 14), 188 + 4);
1188
1189 buf[16] = 0x04; /* Manufacturing info */
1190 buf[17] = 0x40; /* Not writable, is readable */
1191 cpu_to_be16wu((uint16_t *)(buf + 18), 2048 + 4);
1192
1193 /* Size of buffer, not including 2 byte size field */
1194 cpu_to_be16wu((uint16_t *)buf, 16 + 2);
1195
1196 /* data written + 4 byte header */
1197 return (16 + 4);
1198
1199 default: /* TODO: formats beyond DVD-ROM requires */
1200 return -ASC_INV_FIELD_IN_CMD_PACKET;
1201 }
1202}
1203
5391d806
FB		 1204static void ide_atapi_cmd(IDEState *s)
1205{
1206 const uint8_t *packet;
1207 uint8_t *buf;
1208 int max_len;
1209
1210 packet = s->io_buffer;
1211 buf = s->io_buffer;
1212#ifdef DEBUG_IDE_ATAPI
1213 {
1214 int i;
1215 printf("ATAPI limit=0x%x packet:", s->lcyl | (s->hcyl << 8));
1216 for(i = 0; i < ATAPI_PACKET_SIZE; i++) {
1217 printf(" %02x", packet[i]);
1218 }
1219 printf("\n");
1220 }
1221#endif
9118e7f0
AL		 1222 /* If there's a UNIT_ATTENTION condition pending, only
1223 REQUEST_SENSE and INQUIRY commands are allowed to complete. */
1224 if (s->sense_key == SENSE_UNIT_ATTENTION &&
1225 s->io_buffer[0] != GPCMD_REQUEST_SENSE &&
1226 s->io_buffer[0] != GPCMD_INQUIRY) {
1227 ide_atapi_cmd_check_status(s);
1228 return;
1229 }
5391d806
FB		 1230 switch(s->io_buffer[0]) {
1231 case GPCMD_TEST_UNIT_READY:
93c8cfd9 1232 if (bdrv_is_inserted(s->bs) && !s->cdrom_changed) {
5391d806
FB		 1233 ide_atapi_cmd_ok(s);
1234 } else {
93c8cfd9 1235 s->cdrom_changed = 0;
5fafdf24 1236 ide_atapi_cmd_error(s, SENSE_NOT_READY,
5391d806
FB		 1237 ASC_MEDIUM_NOT_PRESENT);
1238 }
1239 break;
d14049ea 1240 case GPCMD_MODE_SENSE_6:
5391d806
FB		 1241 case GPCMD_MODE_SENSE_10:
1242 {
1243 int action, code;
d14049ea
TS		 1244 if (packet[0] == GPCMD_MODE_SENSE_10)
1245 max_len = ube16_to_cpu(packet + 7);
1246 else
1247 max_len = packet[4];
5391d806
FB		 1248 action = packet[2] >> 6;
1249 code = packet[2] & 0x3f;
1250 switch(action) {
1251 case 0: /* current values */
1252 switch(code) {
a70089ce 1253 case GPMODE_R_W_ERROR_PAGE: /* error recovery */
5391d806
FB		 1254 cpu_to_ube16(&buf[0], 16 + 6);
1255 buf[2] = 0x70;
1256 buf[3] = 0;
1257 buf[4] = 0;
1258 buf[5] = 0;
1259 buf[6] = 0;
1260 buf[7] = 0;
1261
1262 buf[8] = 0x01;
1263 buf[9] = 0x06;
1264 buf[10] = 0x00;
1265 buf[11] = 0x05;
1266 buf[12] = 0x00;
1267 buf[13] = 0x00;
1268 buf[14] = 0x00;
1269 buf[15] = 0x00;
1270 ide_atapi_cmd_reply(s, 16, max_len);
1271 break;
fe0d6123
TLSC		 1272 case GPMODE_AUDIO_CTL_PAGE:
1273 cpu_to_ube16(&buf[0], 24 + 6);
1274 buf[2] = 0x70;
1275 buf[3] = 0;
1276 buf[4] = 0;
1277 buf[5] = 0;
1278 buf[6] = 0;
1279 buf[7] = 0;
1280
1281 /* Fill with CDROM audio volume */
1282 buf[17] = 0;
1283 buf[19] = 0;
1284 buf[21] = 0;
1285 buf[23] = 0;
1286
1287 ide_atapi_cmd_reply(s, 24, max_len);
1288 break;
a70089ce 1289 case GPMODE_CAPABILITIES_PAGE:
5391d806
FB		 1290 cpu_to_ube16(&buf[0], 28 + 6);
1291 buf[2] = 0x70;
1292 buf[3] = 0;
1293 buf[4] = 0;
1294 buf[5] = 0;
1295 buf[6] = 0;
1296 buf[7] = 0;
1297
1298 buf[8] = 0x2a;
1299 buf[9] = 0x12;
0d4a05a1 1300 buf[10] = 0x00;
5391d806 1301 buf[11] = 0x00;
3b46e624 1302
d5b4eb40
AL		 1303 /* Claim PLAY_AUDIO capability (0x01) since some Linux
1304 code checks for this to automount media. */
1305 buf[12] = 0x71;
5391d806
FB		 1306 buf[13] = 3 << 5;
1307 buf[14] = (1 << 0) | (1 << 3) | (1 << 5);
caed8802 1308 if (bdrv_is_locked(s->bs))
5391d806
FB		 1309 buf[6] |= 1 << 1;
1310 buf[15] = 0x00;
1311 cpu_to_ube16(&buf[16], 706);
1312 buf[18] = 0;
1313 buf[19] = 2;
1314 cpu_to_ube16(&buf[20], 512);
1315 cpu_to_ube16(&buf[22], 706);
1316 buf[24] = 0;
1317 buf[25] = 0;
1318 buf[26] = 0;
1319 buf[27] = 0;
1320 ide_atapi_cmd_reply(s, 28, max_len);
1321 break;
1322 default:
1323 goto error_cmd;
1324 }
1325 break;
1326 case 1: /* changeable values */
1327 goto error_cmd;
1328 case 2: /* default values */
1329 goto error_cmd;
1330 default:
1331 case 3: /* saved values */
5fafdf24 1332 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
5391d806
FB		 1333 ASC_SAVING_PARAMETERS_NOT_SUPPORTED);
1334 break;
1335 }
1336 }
1337 break;
1338 case GPCMD_REQUEST_SENSE:
1339 max_len = packet[4];
1340 memset(buf, 0, 18);
1341 buf[0] = 0x70 | (1 << 7);
1342 buf[2] = s->sense_key;
1343 buf[7] = 10;
1344 buf[12] = s->asc;
9118e7f0
AL		 1345 if (s->sense_key == SENSE_UNIT_ATTENTION)
1346 s->sense_key = SENSE_NONE;
5391d806
FB		 1347 ide_atapi_cmd_reply(s, 18, max_len);
1348 break;
1349 case GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL:
caed8802
FB		 1350 if (bdrv_is_inserted(s->bs)) {
1351 bdrv_set_locked(s->bs, packet[4] & 1);
5391d806
FB		 1352 ide_atapi_cmd_ok(s);
1353 } else {
5fafdf24 1354 ide_atapi_cmd_error(s, SENSE_NOT_READY,
5391d806
FB		 1355 ASC_MEDIUM_NOT_PRESENT);
1356 }
1357 break;
1358 case GPCMD_READ_10:
1359 case GPCMD_READ_12:
1360 {
1361 int nb_sectors, lba;
1362
5391d806
FB		 1363 if (packet[0] == GPCMD_READ_10)
1364 nb_sectors = ube16_to_cpu(packet + 7);
1365 else
1366 nb_sectors = ube32_to_cpu(packet + 6);
1367 lba = ube32_to_cpu(packet + 2);
1368 if (nb_sectors == 0) {
1369 ide_atapi_cmd_ok(s);
1370 break;
1371 }
98087450
FB		 1372 ide_atapi_cmd_read(s, lba, nb_sectors, 2048);
1373 }
1374 break;
1375 case GPCMD_READ_CD:
1376 {
1377 int nb_sectors, lba, transfer_request;
1378
98087450
FB		 1379 nb_sectors = (packet[6] << 16) | (packet[7] << 8) | packet[8];
1380 lba = ube32_to_cpu(packet + 2);
1381 if (nb_sectors == 0) {
1382 ide_atapi_cmd_ok(s);
1383 break;
1384 }
98087450
FB		 1385 transfer_request = packet[9];
1386 switch(transfer_request & 0xf8) {
1387 case 0x00:
1388 /* nothing */
1389 ide_atapi_cmd_ok(s);
1390 break;
1391 case 0x10:
1392 /* normal read */
1393 ide_atapi_cmd_read(s, lba, nb_sectors, 2048);
1394 break;
1395 case 0xf8:
1396 /* read all data */
1397 ide_atapi_cmd_read(s, lba, nb_sectors, 2352);
1398 break;
1399 default:
5fafdf24 1400 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
98087450
FB		 1401 ASC_INV_FIELD_IN_CMD_PACKET);
1402 break;
1403 }
5391d806
FB		 1404 }
1405 break;
1406 case GPCMD_SEEK:
1407 {
96b8f136
TS		 1408 unsigned int lba;
1409 uint64_t total_sectors;
66c6ef76
FB		 1410
1411 bdrv_get_geometry(s->bs, &total_sectors);
1412 total_sectors >>= 2;
96b8f136 1413 if (total_sectors == 0) {
5fafdf24 1414 ide_atapi_cmd_error(s, SENSE_NOT_READY,
5391d806
FB		 1415 ASC_MEDIUM_NOT_PRESENT);
1416 break;
1417 }
1418 lba = ube32_to_cpu(packet + 2);
66c6ef76 1419 if (lba >= total_sectors) {
5fafdf24 1420 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
5391d806
FB		 1421 ASC_LOGICAL_BLOCK_OOR);
1422 break;
1423 }
1424 ide_atapi_cmd_ok(s);
1425 }
1426 break;
1427 case GPCMD_START_STOP_UNIT:
1428 {
aea2a33c 1429 int start, eject, err = 0;
5391d806
FB		 1430 start = packet[4] & 1;
1431 eject = (packet[4] >> 1) & 1;
3b46e624 1432
aea2a33c
MM		 1433 if (eject) {
1434 err = bdrv_eject(s->bs, !start);
1435 }
1436
1437 switch (err) {
1438 case 0:
1439 ide_atapi_cmd_ok(s);
1440 break;
1441 case -EBUSY:
1442 ide_atapi_cmd_error(s, SENSE_NOT_READY,
1443 ASC_MEDIA_REMOVAL_PREVENTED);
1444 break;
1445 default:
1446 ide_atapi_cmd_error(s, SENSE_NOT_READY,
1447 ASC_MEDIUM_NOT_PRESENT);
1448 break;
caed8802 1449 }
5391d806
FB		 1450 }
1451 break;
1452 case GPCMD_MECHANISM_STATUS:
1453 {
1454 max_len = ube16_to_cpu(packet + 8);
1455 cpu_to_ube16(buf, 0);
1456 /* no current LBA */
1457 buf[2] = 0;
1458 buf[3] = 0;
1459 buf[4] = 0;
1460 buf[5] = 1;
1461 cpu_to_ube16(buf + 6, 0);
1462 ide_atapi_cmd_reply(s, 8, max_len);
1463 }
1464 break;
1465 case GPCMD_READ_TOC_PMA_ATIP:
1466 {
1467 int format, msf, start_track, len;
96b8f136 1468 uint64_t total_sectors;
5391d806 1469
66c6ef76
FB		 1470 bdrv_get_geometry(s->bs, &total_sectors);
1471 total_sectors >>= 2;
96b8f136 1472 if (total_sectors == 0) {
5fafdf24 1473 ide_atapi_cmd_error(s, SENSE_NOT_READY,
5391d806
FB		 1474 ASC_MEDIUM_NOT_PRESENT);
1475 break;
1476 }
1477 max_len = ube16_to_cpu(packet + 7);
1478 format = packet[9] >> 6;
1479 msf = (packet[1] >> 1) & 1;
1480 start_track = packet[6];
1481 switch(format) {
1482 case 0:
66c6ef76 1483 len = cdrom_read_toc(total_sectors, buf, msf, start_track);
5391d806
FB		 1484 if (len < 0)
1485 goto error_cmd;
1486 ide_atapi_cmd_reply(s, len, max_len);
1487 break;
1488 case 1:
1489 /* multi session : only a single session defined */
1490 memset(buf, 0, 12);
1491 buf[1] = 0x0a;
1492 buf[2] = 0x01;
1493 buf[3] = 0x01;
1494 ide_atapi_cmd_reply(s, 12, max_len);
1495 break;
98087450 1496 case 2:
66c6ef76 1497 len = cdrom_read_toc_raw(total_sectors, buf, msf, start_track);
98087450
FB		 1498 if (len < 0)
1499 goto error_cmd;
1500 ide_atapi_cmd_reply(s, len, max_len);
1501 break;
5391d806 1502 default:
7f777bf3 1503 error_cmd:
5fafdf24 1504 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
7f777bf3
FB		 1505 ASC_INV_FIELD_IN_CMD_PACKET);
1506 break;
5391d806
FB		 1507 }
1508 }
1509 break;
1510 case GPCMD_READ_CDVD_CAPACITY:
66c6ef76 1511 {
96b8f136 1512 uint64_t total_sectors;
66c6ef76
FB		 1513
1514 bdrv_get_geometry(s->bs, &total_sectors);
1515 total_sectors >>= 2;
96b8f136 1516 if (total_sectors == 0) {
5fafdf24 1517 ide_atapi_cmd_error(s, SENSE_NOT_READY,
66c6ef76
FB		 1518 ASC_MEDIUM_NOT_PRESENT);
1519 break;
1520 }
1521 /* NOTE: it is really the number of sectors minus 1 */
1522 cpu_to_ube32(buf, total_sectors - 1);
1523 cpu_to_ube32(buf + 4, 2048);
1524 ide_atapi_cmd_reply(s, 8, 8);
5391d806 1525 }
5391d806 1526 break;
d14049ea
TS		 1527 case GPCMD_READ_DVD_STRUCTURE:
1528 {
1529 int media = packet[1];
8114e9e8
TS		 1530 int format = packet[7];
1531 int ret;
d14049ea 1532
8114e9e8 1533 max_len = ube16_to_cpu(packet + 8);
d14049ea 1534
8114e9e8
TS		 1535 if (format < 0xff) {
1536 if (media_is_cd(s)) {
1537 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
1538 ASC_INCOMPATIBLE_FORMAT);
1539 break;
1540 } else if (!media_present(s)) {
1541 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
1542 ASC_INV_FIELD_IN_CMD_PACKET);
1543 break;
1544 }
1545 }
d14049ea 1546
8114e9e8
TS		 1547 memset(buf, 0, max_len > IDE_DMA_BUF_SECTORS * 512 + 4 ?
1548 IDE_DMA_BUF_SECTORS * 512 + 4 : max_len);
d14049ea 1549
8114e9e8
TS		 1550 switch (format) {
1551 case 0x00 ... 0x7f:
1552 case 0xff:
1553 if (media == 0) {
1554 ret = ide_dvd_read_structure(s, format, packet, buf);
d14049ea 1555
8114e9e8
TS		 1556 if (ret < 0)
1557 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST, -ret);
1558 else
1559 ide_atapi_cmd_reply(s, ret, max_len);
d14049ea 1560
8114e9e8
TS		 1561 break;
1562 }
1563 /* TODO: BD support, fall through for now */
1564
1565 /* Generic disk structures */
1566 case 0x80: /* TODO: AACS volume identifier */
1567 case 0x81: /* TODO: AACS media serial number */
1568 case 0x82: /* TODO: AACS media identifier */
1569 case 0x83: /* TODO: AACS media key block */
1570 case 0x90: /* TODO: List of recognized format layers */
1571 case 0xc0: /* TODO: Write protection status */
d14049ea
TS		 1572 default:
1573 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
1574 ASC_INV_FIELD_IN_CMD_PACKET);
1575 break;
1576 }
1577 }
1578 break;
1579 case GPCMD_SET_SPEED:
1580 ide_atapi_cmd_ok(s);
1581 break;
bd0d90b2
FB		 1582 case GPCMD_INQUIRY:
1583 max_len = packet[4];
1584 buf[0] = 0x05; /* CD-ROM */
1585 buf[1] = 0x80; /* removable */
1586 buf[2] = 0x00; /* ISO */
1587 buf[3] = 0x21; /* ATAPI-2 (XXX: put ATAPI-4 ?) */
aa1f17c1 1588 buf[4] = 31; /* additional length */
bd0d90b2
FB		 1589 buf[5] = 0; /* reserved */
1590 buf[6] = 0; /* reserved */
1591 buf[7] = 0; /* reserved */
1592 padstr8(buf + 8, 8, "QEMU");
38cdea7c 1593 padstr8(buf + 16, 16, "QEMU DVD-ROM");
bd0d90b2
FB		 1594 padstr8(buf + 32, 4, QEMU_VERSION);
1595 ide_atapi_cmd_reply(s, 36, max_len);
1596 break;
d14049ea
TS		 1597 case GPCMD_GET_CONFIGURATION:
1598 {
38cdea7c 1599 uint32_t len;
091d055b 1600 uint8_t index = 0;
d14049ea
TS		 1601
1602 /* only feature 0 is supported */
1603 if (packet[2] != 0 || packet[3] != 0) {
1604 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
1605 ASC_INV_FIELD_IN_CMD_PACKET);
1606 break;
1607 }
38cdea7c
AZ		 1608
1609 /* XXX: could result in alignment problems in some architectures */
1610 max_len = ube16_to_cpu(packet + 7);
091d055b 1611
38cdea7c 1612 /*
091d055b
AZ		 1613 * XXX: avoid overflow for io_buffer if max_len is bigger than
1614 * the size of that buffer (dimensioned to max number of
1615 * sectors to transfer at once)
38cdea7c 1616 *
091d055b 1617 * Only a problem if the feature/profiles grow.
38cdea7c
AZ		 1618 */
1619 if (max_len > 512) /* XXX: assume 1 sector */
1620 max_len = 512;
1621
1622 memset(buf, 0, max_len);
1623 /*
1624 * the number of sectors from the media tells us which profile
1625 * to use as current. 0 means there is no media
38cdea7c 1626 */
8114e9e8
TS		 1627 if (media_is_dvd(s))
1628 cpu_to_ube16(buf + 6, MMC_PROFILE_DVD_ROM);
1629 else if (media_is_cd(s))
1630 cpu_to_ube16(buf + 6, MMC_PROFILE_CD_ROM);
38cdea7c 1631
091d055b
AZ		 1632 buf[10] = 0x02 | 0x01; /* persistent and current */
1633 len = 12; /* headers: 8 + 4 */
1634 len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_DVD_ROM);
1635 len += ide_atapi_set_profile(buf, &index, MMC_PROFILE_CD_ROM);
38cdea7c
AZ		 1636 cpu_to_ube32(buf, len - 4); /* data length */
1637
1638 ide_atapi_cmd_reply(s, len, max_len);
d14049ea
TS		 1639 break;
1640 }
5391d806 1641 default:
5fafdf24 1642 ide_atapi_cmd_error(s, SENSE_ILLEGAL_REQUEST,
7f777bf3 1643 ASC_ILLEGAL_OPCODE);
5391d806
FB		 1644 break;
1645 }
1646}
1647
201a51fc
AZ		 1648static void ide_cfata_metadata_inquiry(IDEState *s)
1649{
1650 uint16_t *p;
1651 uint32_t spd;
1652
1653 p = (uint16_t *) s->io_buffer;
1654 memset(p, 0, 0x200);
1655 spd = ((s->mdata_size - 1) >> 9) + 1;
1656
1657 put_le16(p + 0, 0x0001); /* Data format revision */
1658 put_le16(p + 1, 0x0000); /* Media property: silicon */
1659 put_le16(p + 2, s->media_changed); /* Media status */
1660 put_le16(p + 3, s->mdata_size & 0xffff); /* Capacity in bytes (low) */
1661 put_le16(p + 4, s->mdata_size >> 16); /* Capacity in bytes (high) */
1662 put_le16(p + 5, spd & 0xffff); /* Sectors per device (low) */
1663 put_le16(p + 6, spd >> 16); /* Sectors per device (high) */
1664}
1665
1666static void ide_cfata_metadata_read(IDEState *s)
1667{
1668 uint16_t *p;
1669
1670 if (((s->hcyl << 16) | s->lcyl) << 9 > s->mdata_size + 2) {
1671 s->status = ERR_STAT;
1672 s->error = ABRT_ERR;
1673 return;
1674 }
1675
1676 p = (uint16_t *) s->io_buffer;
1677 memset(p, 0, 0x200);
1678
1679 put_le16(p + 0, s->media_changed); /* Media status */
1680 memcpy(p + 1, s->mdata_storage + (((s->hcyl << 16) | s->lcyl) << 9),
1681 MIN(MIN(s->mdata_size - (((s->hcyl << 16) | s->lcyl) << 9),
1682 s->nsector << 9), 0x200 - 2));
1683}
1684
1685static void ide_cfata_metadata_write(IDEState *s)
1686{
1687 if (((s->hcyl << 16) | s->lcyl) << 9 > s->mdata_size + 2) {
1688 s->status = ERR_STAT;
1689 s->error = ABRT_ERR;
1690 return;
1691 }
1692
1693 s->media_changed = 0;
1694
1695 memcpy(s->mdata_storage + (((s->hcyl << 16) | s->lcyl) << 9),
1696 s->io_buffer + 2,
1697 MIN(MIN(s->mdata_size - (((s->hcyl << 16) | s->lcyl) << 9),
1698 s->nsector << 9), 0x200 - 2));
1699}
1700
bd491d6a
TS		 1701/* called when the inserted state of the media has changed */
1702static void cdrom_change_cb(void *opaque)
1703{
1704 IDEState *s = opaque;
96b8f136 1705 uint64_t nb_sectors;
bd491d6a 1706
bd491d6a
TS		 1707 bdrv_get_geometry(s->bs, &nb_sectors);
1708 s->nb_sectors = nb_sectors;
9118e7f0
AL		 1709
1710 s->sense_key = SENSE_UNIT_ATTENTION;
1711 s->asc = ASC_MEDIUM_MAY_HAVE_CHANGED;
93c8cfd9 1712 s->cdrom_changed = 1;
9cdd03a7 1713 ide_set_irq(s->bus);
bd491d6a
TS		 1714}
1715
c2ff060f
FB		 1716static void ide_cmd_lba48_transform(IDEState *s, int lba48)
1717{
1718 s->lba48 = lba48;
1719
1720 /* handle the 'magic' 0 nsector count conversion here. to avoid
1721 * fiddling with the rest of the read logic, we just store the
1722 * full sector count in ->nsector and ignore ->hob_nsector from now
1723 */
1724 if (!s->lba48) {
1725 if (!s->nsector)
1726 s->nsector = 256;
1727 } else {
1728 if (!s->nsector && !s->hob_nsector)
1729 s->nsector = 65536;
1730 else {
1731 int lo = s->nsector;
1732 int hi = s->hob_nsector;
1733
1734 s->nsector = (hi << 8) | lo;
1735 }
1736 }
1737}
1738
bcbdc4d3 1739static void ide_clear_hob(IDEBus *bus)
c2ff060f
FB		 1740{
1741 /* any write clears HOB high bit of device control register */
bcbdc4d3
GH		 1742 bus->ifs[0].select &= ~(1 << 7);
1743 bus->ifs[1].select &= ~(1 << 7);
c2ff060f
FB		 1744}
1745
356721ae 1746void ide_ioport_write(void *opaque, uint32_t addr, uint32_t val)
caed8802 1747{
bcbdc4d3 1748 IDEBus *bus = opaque;
c45c3d00 1749 IDEState *s;
bcbdc4d3 1750 int n;
c2ff060f 1751 int lba48 = 0;
5391d806
FB		 1752
1753#ifdef DEBUG_IDE
1754 printf("IDE: write addr=0x%x val=0x%02x\n", addr, val);
1755#endif
c2ff060f 1756
5391d806 1757 addr &= 7;
fcdd25ab
AL		 1758
1759 /* ignore writes to command block while busy with previous command */
bcbdc4d3 1760 if (addr != 7 && (idebus_active_if(bus)->status & (BUSY_STAT|DRQ_STAT)))
fcdd25ab
AL		 1761 return;
1762
5391d806
FB		 1763 switch(addr) {
1764 case 0:
1765 break;
1766 case 1:
bcbdc4d3 1767 ide_clear_hob(bus);
c45c3d00 1768 /* NOTE: data is written to the two drives */
bcbdc4d3
GH		 1769 bus->ifs[0].hob_feature = bus->ifs[0].feature;
1770 bus->ifs[1].hob_feature = bus->ifs[1].feature;
1771 bus->ifs[0].feature = val;
1772 bus->ifs[1].feature = val;
5391d806
FB		 1773 break;
1774 case 2:
bcbdc4d3
GH		 1775 ide_clear_hob(bus);
1776 bus->ifs[0].hob_nsector = bus->ifs[0].nsector;
1777 bus->ifs[1].hob_nsector = bus->ifs[1].nsector;
1778 bus->ifs[0].nsector = val;
1779 bus->ifs[1].nsector = val;
5391d806
FB		 1780 break;
1781 case 3:
bcbdc4d3
GH		 1782 ide_clear_hob(bus);
1783 bus->ifs[0].hob_sector = bus->ifs[0].sector;
1784 bus->ifs[1].hob_sector = bus->ifs[1].sector;
1785 bus->ifs[0].sector = val;
1786 bus->ifs[1].sector = val;
5391d806
FB		 1787 break;
1788 case 4:
bcbdc4d3
GH		 1789 ide_clear_hob(bus);
1790 bus->ifs[0].hob_lcyl = bus->ifs[0].lcyl;
1791 bus->ifs[1].hob_lcyl = bus->ifs[1].lcyl;
1792 bus->ifs[0].lcyl = val;
1793 bus->ifs[1].lcyl = val;
5391d806
FB		 1794 break;
1795 case 5:
bcbdc4d3
GH		 1796 ide_clear_hob(bus);
1797 bus->ifs[0].hob_hcyl = bus->ifs[0].hcyl;
1798 bus->ifs[1].hob_hcyl = bus->ifs[1].hcyl;
1799 bus->ifs[0].hcyl = val;
1800 bus->ifs[1].hcyl = val;
5391d806
FB		 1801 break;
1802 case 6:
c2ff060f 1803 /* FIXME: HOB readback uses bit 7 */
bcbdc4d3
GH		 1804 bus->ifs[0].select = (val & ~0x10) | 0xa0;
1805 bus->ifs[1].select = (val | 0x10) | 0xa0;
5391d806 1806 /* select drive */
bcbdc4d3 1807 bus->unit = (val >> 4) & 1;
5391d806
FB		 1808 break;
1809 default:
1810 case 7:
1811 /* command */
1812#if defined(DEBUG_IDE)
1813 printf("ide: CMD=%02x\n", val);
1814#endif
bcbdc4d3 1815 s = idebus_active_if(bus);
66201e2d 1816 /* ignore commands to non existant slave */
bcbdc4d3 1817 if (s != bus->ifs && !s->bs)
66201e2d 1818 break;
c2ff060f 1819
fcdd25ab
AL		 1820 /* Only DEVICE RESET is allowed while BSY or/and DRQ are set */
1821 if ((s->status & (BUSY_STAT|DRQ_STAT)) && val != WIN_DEVICE_RESET)
1822 break;
1823
5391d806
FB		 1824 switch(val) {
1825 case WIN_IDENTIFY:
1826 if (s->bs && !s->is_cdrom) {
201a51fc
AZ		 1827 if (!s->is_cf)
1828 ide_identify(s);
1829 else
1830 ide_cfata_identify(s);
2a282056 1831 s->status = READY_STAT | SEEK_STAT;
5391d806
FB		 1832 ide_transfer_start(s, s->io_buffer, 512, ide_transfer_stop);
1833 } else {
1834 if (s->is_cdrom) {
1835 ide_set_signature(s);
1836 }
1837 ide_abort_command(s);
1838 }
9cdd03a7 1839 ide_set_irq(s->bus);
5391d806
FB		 1840 break;
1841 case WIN_SPECIFY:
1842 case WIN_RECAL:
a136e5a8 1843 s->error = 0;
769bec72 1844 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 1845 ide_set_irq(s->bus);
5391d806
FB		 1846 break;
1847 case WIN_SETMULT:
201a51fc
AZ		 1848 if (s->is_cf && s->nsector == 0) {
1849 /* Disable Read and Write Multiple */
1850 s->mult_sectors = 0;
41a2b959 1851 s->status = READY_STAT | SEEK_STAT;
201a51fc 1852 } else if ((s->nsector & 0xff) != 0 &&
39dfc926
TS		 1853 ((s->nsector & 0xff) > MAX_MULT_SECTORS ||
1854 (s->nsector & (s->nsector - 1)) != 0)) {
5391d806
FB		 1855 ide_abort_command(s);
1856 } else {
292eef5a 1857 s->mult_sectors = s->nsector & 0xff;
41a2b959 1858 s->status = READY_STAT | SEEK_STAT;
5391d806 1859 }
9cdd03a7 1860 ide_set_irq(s->bus);
5391d806 1861 break;
c2ff060f
FB		 1862 case WIN_VERIFY_EXT:
1863 lba48 = 1;
4ce900b4
FB		 1864 case WIN_VERIFY:
1865 case WIN_VERIFY_ONCE:
1866 /* do sector number check ? */
c2ff060f 1867 ide_cmd_lba48_transform(s, lba48);
41a2b959 1868 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 1869 ide_set_irq(s->bus);
4ce900b4 1870 break;
c2ff060f
FB		 1871 case WIN_READ_EXT:
1872 lba48 = 1;
5391d806
FB		 1873 case WIN_READ:
1874 case WIN_READ_ONCE:
5fafdf24 1875 if (!s->bs)
6b136f9e 1876 goto abort_cmd;
c2ff060f 1877 ide_cmd_lba48_transform(s, lba48);
5391d806
FB		 1878 s->req_nb_sectors = 1;
1879 ide_sector_read(s);
1880 break;
c2ff060f
FB		 1881 case WIN_WRITE_EXT:
1882 lba48 = 1;
5391d806
FB		 1883 case WIN_WRITE:
1884 case WIN_WRITE_ONCE:
201a51fc
AZ		 1885 case CFA_WRITE_SECT_WO_ERASE:
1886 case WIN_WRITE_VERIFY:
c2ff060f 1887 ide_cmd_lba48_transform(s, lba48);
a136e5a8 1888 s->error = 0;
f66723fa 1889 s->status = SEEK_STAT | READY_STAT;
5391d806
FB		 1890 s->req_nb_sectors = 1;
1891 ide_transfer_start(s, s->io_buffer, 512, ide_sector_write);
201a51fc 1892 s->media_changed = 1;
5391d806 1893 break;
c2ff060f
FB		 1894 case WIN_MULTREAD_EXT:
1895 lba48 = 1;
5391d806
FB		 1896 case WIN_MULTREAD:
1897 if (!s->mult_sectors)
1898 goto abort_cmd;
c2ff060f 1899 ide_cmd_lba48_transform(s, lba48);
5391d806
FB		 1900 s->req_nb_sectors = s->mult_sectors;
1901 ide_sector_read(s);
1902 break;
c2ff060f
FB		 1903 case WIN_MULTWRITE_EXT:
1904 lba48 = 1;
5391d806 1905 case WIN_MULTWRITE:
201a51fc 1906 case CFA_WRITE_MULTI_WO_ERASE:
5391d806
FB		 1907 if (!s->mult_sectors)
1908 goto abort_cmd;
c2ff060f 1909 ide_cmd_lba48_transform(s, lba48);
a136e5a8 1910 s->error = 0;
f66723fa 1911 s->status = SEEK_STAT | READY_STAT;
5391d806
FB		 1912 s->req_nb_sectors = s->mult_sectors;
1913 n = s->nsector;
1914 if (n > s->req_nb_sectors)
1915 n = s->req_nb_sectors;
1916 ide_transfer_start(s, s->io_buffer, 512 * n, ide_sector_write);
201a51fc 1917 s->media_changed = 1;
5391d806 1918 break;
c2ff060f
FB		 1919 case WIN_READDMA_EXT:
1920 lba48 = 1;
98087450
FB		 1921 case WIN_READDMA:
1922 case WIN_READDMA_ONCE:
5fafdf24 1923 if (!s->bs)
98087450 1924 goto abort_cmd;
c2ff060f 1925 ide_cmd_lba48_transform(s, lba48);
98087450
FB		 1926 ide_sector_read_dma(s);
1927 break;
c2ff060f
FB		 1928 case WIN_WRITEDMA_EXT:
1929 lba48 = 1;
98087450
FB		 1930 case WIN_WRITEDMA:
1931 case WIN_WRITEDMA_ONCE:
5fafdf24 1932 if (!s->bs)
98087450 1933 goto abort_cmd;
c2ff060f 1934 ide_cmd_lba48_transform(s, lba48);
98087450 1935 ide_sector_write_dma(s);
201a51fc 1936 s->media_changed = 1;
98087450 1937 break;
c2ff060f
FB		 1938 case WIN_READ_NATIVE_MAX_EXT:
1939 lba48 = 1;
5391d806 1940 case WIN_READ_NATIVE_MAX:
c2ff060f 1941 ide_cmd_lba48_transform(s, lba48);
5391d806 1942 ide_set_sector(s, s->nb_sectors - 1);
41a2b959 1943 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 1944 ide_set_irq(s->bus);
5391d806 1945 break;
a136e5a8 1946 case WIN_CHECKPOWERMODE1:
201a51fc 1947 case WIN_CHECKPOWERMODE2:
a136e5a8 1948 s->nsector = 0xff; /* device active or idle */
41a2b959 1949 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 1950 ide_set_irq(s->bus);
a136e5a8 1951 break;
34e538ae
FB		 1952 case WIN_SETFEATURES:
1953 if (!s->bs)
1954 goto abort_cmd;
1955 /* XXX: valid for CDROM ? */
1956 switch(s->feature) {
e1f63470
TS		 1957 case 0xcc: /* reverting to power-on defaults enable */
1958 case 0x66: /* reverting to power-on defaults disable */
34e538ae
FB		 1959 case 0x02: /* write cache enable */
1960 case 0x82: /* write cache disable */
1961 case 0xaa: /* read look-ahead enable */
1962 case 0x55: /* read look-ahead disable */
201a51fc
AZ		 1963 case 0x05: /* set advanced power management mode */
1964 case 0x85: /* disable advanced power management mode */
1965 case 0x69: /* NOP */
1966 case 0x67: /* NOP */
1967 case 0x96: /* NOP */
1968 case 0x9a: /* NOP */
c3e88d8c
TS		 1969 case 0x42: /* enable Automatic Acoustic Mode */
1970 case 0xc2: /* disable Automatic Acoustic Mode */
e0fe67aa 1971 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 1972 ide_set_irq(s->bus);
34e538ae 1973 break;
94458802
FB		 1974 case 0x03: { /* set transfer mode */
1975 uint8_t val = s->nsector & 0x07;
96c35ceb 1976 uint16_t *identify_data = (uint16_t *)s->identify_data;
94458802
FB		 1977
1978 switch (s->nsector >> 3) {
1979 case 0x00: /* pio default */
1980 case 0x01: /* pio mode */
96c35ceb
JQ		 1981 put_le16(identify_data + 62,0x07);
1982 put_le16(identify_data + 63,0x07);
1983 put_le16(identify_data + 88,0x3f);
d1b5c20d
TS		 1984 break;
1985 case 0x02: /* sigle word dma mode*/
96c35ceb
JQ		 1986 put_le16(identify_data + 62,0x07 | (1 << (val + 8)));
1987 put_le16(identify_data + 63,0x07);
1988 put_le16(identify_data + 88,0x3f);
94458802
FB		 1989 break;
1990 case 0x04: /* mdma mode */
96c35ceb
JQ		 1991 put_le16(identify_data + 62,0x07);
1992 put_le16(identify_data + 63,0x07 | (1 << (val + 8)));
1993 put_le16(identify_data + 88,0x3f);
94458802
FB		 1994 break;
1995 case 0x08: /* udma mode */
96c35ceb
JQ		 1996 put_le16(identify_data + 62,0x07);
1997 put_le16(identify_data + 63,0x07);
1998 put_le16(identify_data + 88,0x3f | (1 << (val + 8)));
94458802
FB		 1999 break;
2000 default:
2001 goto abort_cmd;
2002 }
2003 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2004 ide_set_irq(s->bus);
94458802
FB		 2005 break;
2006 }
34e538ae
FB		 2007 default:
2008 goto abort_cmd;
2009 }
2010 break;
c2ff060f
FB		 2011 case WIN_FLUSH_CACHE:
2012 case WIN_FLUSH_CACHE_EXT:
7a6cba61 2013 if (s->bs)
b0484ae4
CH		 2014 bdrv_aio_flush(s->bs, ide_flush_cb, s);
2015 else
2016 ide_flush_cb(s, 0);
7a6cba61 2017 break;
c3e88d8c
TS		 2018 case WIN_STANDBY:
2019 case WIN_STANDBY2:
2020 case WIN_STANDBYNOW1:
201a51fc 2021 case WIN_STANDBYNOW2:
c451ee71 2022 case WIN_IDLEIMMEDIATE:
201a51fc
AZ		 2023 case CFA_IDLEIMMEDIATE:
2024 case WIN_SETIDLE1:
2025 case WIN_SETIDLE2:
c3e88d8c
TS		 2026 case WIN_SLEEPNOW1:
2027 case WIN_SLEEPNOW2:
2028 s->status = READY_STAT;
9cdd03a7 2029 ide_set_irq(s->bus);
a7dfe172 2030 break;
4fbfcd6d
AJ		 2031 case WIN_SEEK:
2032 if(s->is_cdrom)
2033 goto abort_cmd;
2034 /* XXX: Check that seek is within bounds */
2035 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2036 ide_set_irq(s->bus);
4fbfcd6d 2037 break;
5391d806
FB		 2038 /* ATAPI commands */
2039 case WIN_PIDENTIFY:
2040 if (s->is_cdrom) {
2041 ide_atapi_identify(s);
1298fe63 2042 s->status = READY_STAT | SEEK_STAT;
5391d806
FB		 2043 ide_transfer_start(s, s->io_buffer, 512, ide_transfer_stop);
2044 } else {
2045 ide_abort_command(s);
2046 }
9cdd03a7 2047 ide_set_irq(s->bus);
5391d806 2048 break;
c451ee71
FB		 2049 case WIN_DIAGNOSE:
2050 ide_set_signature(s);
33256a25
AL		 2051 if (s->is_cdrom)
2052 s->status = 0; /* ATAPI spec (v6) section 9.10 defines packet
2053 * devices to return a clear status register
2054 * with READY_STAT *not* set. */
2055 else
2056 s->status = READY_STAT | SEEK_STAT;
2057 s->error = 0x01; /* Device 0 passed, Device 1 passed or not
2058 * present.
2059 */
9cdd03a7 2060 ide_set_irq(s->bus);
c451ee71 2061 break;
5391d806
FB		 2062 case WIN_SRST:
2063 if (!s->is_cdrom)
2064 goto abort_cmd;
2065 ide_set_signature(s);
6b136f9e 2066 s->status = 0x00; /* NOTE: READY is _not_ set */
5391d806
FB		 2067 s->error = 0x01;
2068 break;
2069 case WIN_PACKETCMD:
2070 if (!s->is_cdrom)
2071 goto abort_cmd;
98087450
FB		 2072 /* overlapping commands not supported */
2073 if (s->feature & 0x02)
5391d806 2074 goto abort_cmd;
41a2b959 2075 s->status = READY_STAT | SEEK_STAT;
98087450 2076 s->atapi_dma = s->feature & 1;
5391d806 2077 s->nsector = 1;
5fafdf24 2078 ide_transfer_start(s, s->io_buffer, ATAPI_PACKET_SIZE,
5391d806
FB		 2079 ide_atapi_cmd);
2080 break;
201a51fc
AZ		 2081 /* CF-ATA commands */
2082 case CFA_REQ_EXT_ERROR_CODE:
2083 if (!s->is_cf)
2084 goto abort_cmd;
2085 s->error = 0x09; /* miscellaneous error */
41a2b959 2086 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2087 ide_set_irq(s->bus);
201a51fc
AZ		 2088 break;
2089 case CFA_ERASE_SECTORS:
2090 case CFA_WEAR_LEVEL:
2091 if (!s->is_cf)
2092 goto abort_cmd;
2093 if (val == CFA_WEAR_LEVEL)
2094 s->nsector = 0;
2095 if (val == CFA_ERASE_SECTORS)
2096 s->media_changed = 1;
2097 s->error = 0x00;
41a2b959 2098 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2099 ide_set_irq(s->bus);
201a51fc
AZ		 2100 break;
2101 case CFA_TRANSLATE_SECTOR:
2102 if (!s->is_cf)
2103 goto abort_cmd;
2104 s->error = 0x00;
41a2b959 2105 s->status = READY_STAT | SEEK_STAT;
201a51fc
AZ		 2106 memset(s->io_buffer, 0, 0x200);
2107 s->io_buffer[0x00] = s->hcyl; /* Cyl MSB */
2108 s->io_buffer[0x01] = s->lcyl; /* Cyl LSB */
2109 s->io_buffer[0x02] = s->select; /* Head */
2110 s->io_buffer[0x03] = s->sector; /* Sector */
2111 s->io_buffer[0x04] = ide_get_sector(s) >> 16; /* LBA MSB */
2112 s->io_buffer[0x05] = ide_get_sector(s) >> 8; /* LBA */
2113 s->io_buffer[0x06] = ide_get_sector(s) >> 0; /* LBA LSB */
2114 s->io_buffer[0x13] = 0x00; /* Erase flag */
2115 s->io_buffer[0x18] = 0x00; /* Hot count */
2116 s->io_buffer[0x19] = 0x00; /* Hot count */
2117 s->io_buffer[0x1a] = 0x01; /* Hot count */
2118 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop);
9cdd03a7 2119 ide_set_irq(s->bus);
201a51fc
AZ		 2120 break;
2121 case CFA_ACCESS_METADATA_STORAGE:
2122 if (!s->is_cf)
2123 goto abort_cmd;
2124 switch (s->feature) {
2125 case 0x02: /* Inquiry Metadata Storage */
2126 ide_cfata_metadata_inquiry(s);
2127 break;
2128 case 0x03: /* Read Metadata Storage */
2129 ide_cfata_metadata_read(s);
2130 break;
2131 case 0x04: /* Write Metadata Storage */
2132 ide_cfata_metadata_write(s);
2133 break;
2134 default:
2135 goto abort_cmd;
2136 }
2137 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop);
2138 s->status = 0x00; /* NOTE: READY is _not_ set */
9cdd03a7 2139 ide_set_irq(s->bus);
201a51fc
AZ		 2140 break;
2141 case IBM_SENSE_CONDITION:
2142 if (!s->is_cf)
2143 goto abort_cmd;
2144 switch (s->feature) {
2145 case 0x01: /* sense temperature in device */
2146 s->nsector = 0x50; /* +20 C */
2147 break;
2148 default:
2149 goto abort_cmd;
2150 }
41a2b959 2151 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2152 ide_set_irq(s->bus);
201a51fc 2153 break;
e8b54394
BW		 2154
2155 case WIN_SMART:
2156 if (s->is_cdrom)
2157 goto abort_cmd;
2158 if (s->hcyl != 0xc2 || s->lcyl != 0x4f)
2159 goto abort_cmd;
2160 if (!s->smart_enabled && s->feature != SMART_ENABLE)
2161 goto abort_cmd;
2162 switch (s->feature) {
2163 case SMART_DISABLE:
2164 s->smart_enabled = 0;
2165 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2166 ide_set_irq(s->bus);
e8b54394
BW		 2167 break;
2168 case SMART_ENABLE:
2169 s->smart_enabled = 1;
2170 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2171 ide_set_irq(s->bus);
e8b54394
BW		 2172 break;
2173 case SMART_ATTR_AUTOSAVE:
2174 switch (s->sector) {
2175 case 0x00:
2176 s->smart_autosave = 0;
2177 break;
2178 case 0xf1:
2179 s->smart_autosave = 1;
2180 break;
2181 default:
2182 goto abort_cmd;
2183 }
2184 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2185 ide_set_irq(s->bus);
e8b54394
BW		 2186 break;
2187 case SMART_STATUS:
2188 if (!s->smart_errors) {
2189 s->hcyl = 0xc2;
2190 s->lcyl = 0x4f;
2191 } else {
2192 s->hcyl = 0x2c;
2193 s->lcyl = 0xf4;
2194 }
2195 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2196 ide_set_irq(s->bus);
e8b54394
BW		 2197 break;
2198 case SMART_READ_THRESH:
2199 memset(s->io_buffer, 0, 0x200);
2200 s->io_buffer[0] = 0x01; /* smart struct version */
2201 for (n=0; n<30; n++) {
2202 if (smart_attributes[n][0] == 0)
2203 break;
2204 s->io_buffer[2+0+(n*12)] = smart_attributes[n][0];
2205 s->io_buffer[2+1+(n*12)] = smart_attributes[n][4];
2206 }
2207 for (n=0; n<511; n++) /* checksum */
2208 s->io_buffer[511] += s->io_buffer[n];
2209 s->io_buffer[511] = 0x100 - s->io_buffer[511];
2210 s->status = READY_STAT | SEEK_STAT;
2211 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop);
9cdd03a7 2212 ide_set_irq(s->bus);
e8b54394
BW		 2213 break;
2214 case SMART_READ_DATA:
2215 memset(s->io_buffer, 0, 0x200);
2216 s->io_buffer[0] = 0x01; /* smart struct version */
2217 for (n=0; n<30; n++) {
2218 if (smart_attributes[n][0] == 0)
2219 break;
2220 s->io_buffer[2+0+(n*12)] = smart_attributes[n][0];
2221 s->io_buffer[2+1+(n*12)] = smart_attributes[n][1];
2222 s->io_buffer[2+3+(n*12)] = smart_attributes[n][2];
2223 s->io_buffer[2+4+(n*12)] = smart_attributes[n][3];
2224 }
2225 s->io_buffer[362] = 0x02 | (s->smart_autosave?0x80:0x00);
2226 if (s->smart_selftest_count == 0) {
2227 s->io_buffer[363] = 0;
2228 } else {
2229 s->io_buffer[363] =
2230 s->smart_selftest_data[3 +
2231 (s->smart_selftest_count - 1) *
2232 24];
2233 }
2234 s->io_buffer[364] = 0x20;
2235 s->io_buffer[365] = 0x01;
2236 /* offline data collection capacity: execute + self-test*/
2237 s->io_buffer[367] = (1<<4 | 1<<3 | 1);
2238 s->io_buffer[368] = 0x03; /* smart capability (1) */
2239 s->io_buffer[369] = 0x00; /* smart capability (2) */
2240 s->io_buffer[370] = 0x01; /* error logging supported */
2241 s->io_buffer[372] = 0x02; /* minutes for poll short test */
2242 s->io_buffer[373] = 0x36; /* minutes for poll ext test */
2243 s->io_buffer[374] = 0x01; /* minutes for poll conveyance */
2244
2245 for (n=0; n<511; n++)
2246 s->io_buffer[511] += s->io_buffer[n];
2247 s->io_buffer[511] = 0x100 - s->io_buffer[511];
2248 s->status = READY_STAT | SEEK_STAT;
2249 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop);
9cdd03a7 2250 ide_set_irq(s->bus);
e8b54394
BW		 2251 break;
2252 case SMART_READ_LOG:
2253 switch (s->sector) {
2254 case 0x01: /* summary smart error log */
2255 memset(s->io_buffer, 0, 0x200);
2256 s->io_buffer[0] = 0x01;
2257 s->io_buffer[1] = 0x00; /* no error entries */
2258 s->io_buffer[452] = s->smart_errors & 0xff;
2259 s->io_buffer[453] = (s->smart_errors & 0xff00) >> 8;
2260
2261 for (n=0; n<511; n++)
2262 s->io_buffer[511] += s->io_buffer[n];
2263 s->io_buffer[511] = 0x100 - s->io_buffer[511];
2264 break;
2265 case 0x06: /* smart self test log */
2266 memset(s->io_buffer, 0, 0x200);
2267 s->io_buffer[0] = 0x01;
2268 if (s->smart_selftest_count == 0) {
2269 s->io_buffer[508] = 0;
2270 } else {
2271 s->io_buffer[508] = s->smart_selftest_count;
2272 for (n=2; n<506; n++)
2273 s->io_buffer[n] = s->smart_selftest_data[n];
2274 }
2275 for (n=0; n<511; n++)
2276 s->io_buffer[511] += s->io_buffer[n];
2277 s->io_buffer[511] = 0x100 - s->io_buffer[511];
2278 break;
2279 default:
2280 goto abort_cmd;
2281 }
2282 s->status = READY_STAT | SEEK_STAT;
2283 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop);
9cdd03a7 2284 ide_set_irq(s->bus);
e8b54394
BW		 2285 break;
2286 case SMART_EXECUTE_OFFLINE:
2287 switch (s->sector) {
2288 case 0: /* off-line routine */
2289 case 1: /* short self test */
2290 case 2: /* extended self test */
2291 s->smart_selftest_count++;
2292 if(s->smart_selftest_count > 21)
2293 s->smart_selftest_count = 0;
2294 n = 2 + (s->smart_selftest_count - 1) * 24;
2295 s->smart_selftest_data[n] = s->sector;
2296 s->smart_selftest_data[n+1] = 0x00; /* OK and finished */
2297 s->smart_selftest_data[n+2] = 0x34; /* hour count lsb */
2298 s->smart_selftest_data[n+3] = 0x12; /* hour count msb */
2299 s->status = READY_STAT | SEEK_STAT;
9cdd03a7 2300 ide_set_irq(s->bus);
e8b54394
BW		 2301 break;
2302 default:
2303 goto abort_cmd;
2304 }
2305 break;
2306 default:
2307 goto abort_cmd;
2308 }
2309 break;
5391d806
FB		 2310 default:
2311 abort_cmd:
2312 ide_abort_command(s);
9cdd03a7 2313 ide_set_irq(s->bus);
5391d806
FB		 2314 break;
2315 }
2316 }
2317}
2318
356721ae 2319uint32_t ide_ioport_read(void *opaque, uint32_t addr1)
5391d806 2320{
bcbdc4d3
GH		 2321 IDEBus *bus = opaque;
2322 IDEState *s = idebus_active_if(bus);
5391d806 2323 uint32_t addr;
c2ff060f 2324 int ret, hob;
5391d806
FB		 2325
2326 addr = addr1 & 7;
c2ff060f
FB		 2327 /* FIXME: HOB readback uses bit 7, but it's always set right now */
2328 //hob = s->select & (1 << 7);
2329 hob = 0;
5391d806
FB		 2330 switch(addr) {
2331 case 0:
2332 ret = 0xff;
2333 break;
2334 case 1:
bcbdc4d3
GH		 2335 if ((!bus->ifs[0].bs && !bus->ifs[1].bs) ||
2336 (s != bus->ifs && !s->bs))
c45c3d00 2337 ret = 0;
c2ff060f 2338 else if (!hob)
c45c3d00 2339 ret = s->error;
c2ff060f
FB		 2340 else
2341 ret = s->hob_feature;
5391d806
FB		 2342 break;
2343 case 2:
bcbdc4d3 2344 if (!bus->ifs[0].bs && !bus->ifs[1].bs)
c45c3d00 2345 ret = 0;
c2ff060f 2346 else if (!hob)
c45c3d00 2347 ret = s->nsector & 0xff;
c2ff060f
FB		 2348 else
2349 ret = s->hob_nsector;
5391d806
FB		 2350 break;
2351 case 3:
bcbdc4d3 2352 if (!bus->ifs[0].bs && !bus->ifs[1].bs)
c45c3d00 2353 ret = 0;
c2ff060f 2354 else if (!hob)
c45c3d00 2355 ret = s->sector;
c2ff060f
FB		 2356 else
2357 ret = s->hob_sector;
5391d806
FB		 2358 break;
2359 case 4:
bcbdc4d3 2360 if (!bus->ifs[0].bs && !bus->ifs[1].bs)
c45c3d00 2361 ret = 0;
c2ff060f 2362 else if (!hob)
c45c3d00 2363 ret = s->lcyl;
c2ff060f
FB		 2364 else
2365 ret = s->hob_lcyl;
5391d806
FB		 2366 break;
2367 case 5:
bcbdc4d3 2368 if (!bus->ifs[0].bs && !bus->ifs[1].bs)
c45c3d00 2369 ret = 0;
c2ff060f 2370 else if (!hob)
c45c3d00 2371 ret = s->hcyl;
c2ff060f
FB		 2372 else
2373 ret = s->hob_hcyl;
5391d806
FB		 2374 break;
2375 case 6:
bcbdc4d3 2376 if (!bus->ifs[0].bs && !bus->ifs[1].bs)
c45c3d00
FB		 2377 ret = 0;
2378 else
7ae98627 2379 ret = s->select;
5391d806
FB		 2380 break;
2381 default:
2382 case 7:
bcbdc4d3
GH		 2383 if ((!bus->ifs[0].bs && !bus->ifs[1].bs) ||
2384 (s != bus->ifs && !s->bs))
c45c3d00
FB		 2385 ret = 0;
2386 else
2387 ret = s->status;
9cdd03a7 2388 qemu_irq_lower(bus->irq);
5391d806
FB		 2389 break;
2390 }
2391#ifdef DEBUG_IDE
2392 printf("ide: read addr=0x%x val=%02x\n", addr1, ret);
2393#endif
2394 return ret;
2395}
2396
356721ae 2397uint32_t ide_status_read(void *opaque, uint32_t addr)
5391d806 2398{
bcbdc4d3
GH		 2399 IDEBus *bus = opaque;
2400 IDEState *s = idebus_active_if(bus);
5391d806 2401 int ret;
7ae98627 2402
bcbdc4d3
GH		 2403 if ((!bus->ifs[0].bs && !bus->ifs[1].bs) ||
2404 (s != bus->ifs && !s->bs))
7ae98627
FB		 2405 ret = 0;
2406 else
2407 ret = s->status;
5391d806
FB		 2408#ifdef DEBUG_IDE
2409 printf("ide: read status addr=0x%x val=%02x\n", addr, ret);
2410#endif
2411 return ret;
2412}
2413
356721ae 2414void ide_cmd_write(void *opaque, uint32_t addr, uint32_t val)
5391d806 2415{
bcbdc4d3 2416 IDEBus *bus = opaque;
5391d806
FB		 2417 IDEState *s;
2418 int i;
2419
2420#ifdef DEBUG_IDE
2421 printf("ide: write control addr=0x%x val=%02x\n", addr, val);
2422#endif
2423 /* common for both drives */
9cdd03a7 2424 if (!(bus->cmd & IDE_CMD_RESET) &&
5391d806
FB		 2425 (val & IDE_CMD_RESET)) {
2426 /* reset low to high */
2427 for(i = 0;i < 2; i++) {
bcbdc4d3 2428 s = &bus->ifs[i];
5391d806
FB		 2429 s->status = BUSY_STAT | SEEK_STAT;
2430 s->error = 0x01;
2431 }
9cdd03a7 2432 } else if ((bus->cmd & IDE_CMD_RESET) &&
5391d806
FB		 2433 !(val & IDE_CMD_RESET)) {
2434 /* high to low */
2435 for(i = 0;i < 2; i++) {
bcbdc4d3 2436 s = &bus->ifs[i];
6b136f9e
FB		 2437 if (s->is_cdrom)
2438 s->status = 0x00; /* NOTE: READY is _not_ set */
2439 else
56bf1d37 2440 s->status = READY_STAT | SEEK_STAT;
5391d806
FB		 2441 ide_set_signature(s);
2442 }
2443 }
2444
9cdd03a7 2445 bus->cmd = val;
5391d806
FB		 2446}
2447
356721ae 2448void ide_data_writew(void *opaque, uint32_t addr, uint32_t val)
5391d806 2449{
bcbdc4d3
GH		 2450 IDEBus *bus = opaque;
2451 IDEState *s = idebus_active_if(bus);
5391d806
FB		 2452 uint8_t *p;
2453
fcdd25ab
AL		 2454 /* PIO data access allowed only when DRQ bit is set */
2455 if (!(s->status & DRQ_STAT))
2456 return;
2457
5391d806 2458 p = s->data_ptr;
0c4ad8dc 2459 *(uint16_t *)p = le16_to_cpu(val);
5391d806
FB		 2460 p += 2;
2461 s->data_ptr = p;
2462 if (p >= s->data_end)
2463 s->end_transfer_func(s);
2464}
2465
356721ae 2466uint32_t ide_data_readw(void *opaque, uint32_t addr)
5391d806 2467{
bcbdc4d3
GH		 2468 IDEBus *bus = opaque;
2469 IDEState *s = idebus_active_if(bus);
5391d806
FB		 2470 uint8_t *p;
2471 int ret;
fcdd25ab
AL		 2472
2473 /* PIO data access allowed only when DRQ bit is set */
2474 if (!(s->status & DRQ_STAT))
2475 return 0;
2476
5391d806 2477 p = s->data_ptr;
0c4ad8dc 2478 ret = cpu_to_le16(*(uint16_t *)p);
5391d806
FB		 2479 p += 2;
2480 s->data_ptr = p;
2481 if (p >= s->data_end)
2482 s->end_transfer_func(s);
2483 return ret;
2484}
2485
356721ae 2486void ide_data_writel(void *opaque, uint32_t addr, uint32_t val)
5391d806 2487{
bcbdc4d3
GH		 2488 IDEBus *bus = opaque;
2489 IDEState *s = idebus_active_if(bus);
5391d806
FB		 2490 uint8_t *p;
2491
fcdd25ab
AL		 2492 /* PIO data access allowed only when DRQ bit is set */
2493 if (!(s->status & DRQ_STAT))
2494 return;
2495
5391d806 2496 p = s->data_ptr;
0c4ad8dc 2497 *(uint32_t *)p = le32_to_cpu(val);
5391d806
FB		 2498 p += 4;
2499 s->data_ptr = p;
2500 if (p >= s->data_end)
2501 s->end_transfer_func(s);
2502}
2503
356721ae 2504uint32_t ide_data_readl(void *opaque, uint32_t addr)
5391d806 2505{
bcbdc4d3
GH		 2506 IDEBus *bus = opaque;
2507 IDEState *s = idebus_active_if(bus);
5391d806
FB		 2508 uint8_t *p;
2509 int ret;
3b46e624 2510
fcdd25ab
AL		 2511 /* PIO data access allowed only when DRQ bit is set */
2512 if (!(s->status & DRQ_STAT))
2513 return 0;
2514
5391d806 2515 p = s->data_ptr;
0c4ad8dc 2516 ret = cpu_to_le32(*(uint32_t *)p);
5391d806
FB		 2517 p += 4;
2518 s->data_ptr = p;
2519 if (p >= s->data_end)
2520 s->end_transfer_func(s);
2521 return ret;
2522}
2523
a7dfe172
FB		 2524static void ide_dummy_transfer_stop(IDEState *s)
2525{
2526 s->data_ptr = s->io_buffer;
2527 s->data_end = s->io_buffer;
2528 s->io_buffer[0] = 0xff;
2529 s->io_buffer[1] = 0xff;
2530 s->io_buffer[2] = 0xff;
2531 s->io_buffer[3] = 0xff;
2532}
2533
4a643563 2534static void ide_reset(IDEState *s)
5391d806 2535{
4a643563
BS		 2536#ifdef DEBUG_IDE
2537 printf("ide: reset\n");
2538#endif
201a51fc
AZ		 2539 if (s->is_cf)
2540 s->mult_sectors = 0;
2541 else
2542 s->mult_sectors = MAX_MULT_SECTORS;
4a643563
BS		 2543 /* ide regs */
2544 s->feature = 0;
2545 s->error = 0;
2546 s->nsector = 0;
2547 s->sector = 0;
2548 s->lcyl = 0;
2549 s->hcyl = 0;
2550
2551 /* lba48 */
2552 s->hob_feature = 0;
2553 s->hob_sector = 0;
2554 s->hob_nsector = 0;
2555 s->hob_lcyl = 0;
2556 s->hob_hcyl = 0;
2557
5391d806 2558 s->select = 0xa0;
41a2b959 2559 s->status = READY_STAT | SEEK_STAT;
4a643563
BS		 2560
2561 s->lba48 = 0;
2562
2563 /* ATAPI specific */
2564 s->sense_key = 0;
2565 s->asc = 0;
2566 s->cdrom_changed = 0;
2567 s->packet_transfer_size = 0;
2568 s->elementary_transfer_size = 0;
2569 s->io_buffer_index = 0;
2570 s->cd_sector_size = 0;
2571 s->atapi_dma = 0;
2572 /* ATA DMA state */
2573 s->io_buffer_size = 0;
2574 s->req_nb_sectors = 0;
2575
5391d806 2576 ide_set_signature(s);
a7dfe172
FB		 2577 /* init the transfer handler so that 0xffff is returned on data
2578 accesses */
2579 s->end_transfer_func = ide_dummy_transfer_stop;
2580 ide_dummy_transfer_stop(s);
201a51fc 2581 s->media_changed = 0;
5391d806
FB		 2582}
2583
4a643563
BS		 2584void ide_bus_reset(IDEBus *bus)
2585{
2586 bus->unit = 0;
2587 bus->cmd = 0;
2588 ide_reset(&bus->ifs[0]);
2589 ide_reset(&bus->ifs[1]);
2590 ide_clear_hob(bus);
2591}
2592
88804180
GH		 2593void ide_init_drive(IDEState *s, DriveInfo *dinfo)
2594{
2595 int cylinders, heads, secs;
2596 uint64_t nb_sectors;
2597
2598 if (dinfo && dinfo->bdrv) {
2599 s->bs = dinfo->bdrv;
2600 bdrv_get_geometry(s->bs, &nb_sectors);
2601 bdrv_guess_geometry(s->bs, &cylinders, &heads, &secs);
2602 s->cylinders = cylinders;
2603 s->heads = heads;
2604 s->sectors = secs;
2605 s->nb_sectors = nb_sectors;
2606 /* The SMART values should be preserved across power cycles
2607 but they aren't. */
2608 s->smart_enabled = 1;
2609 s->smart_autosave = 1;
2610 s->smart_errors = 0;
2611 s->smart_selftest_count = 0;
2612 if (bdrv_get_type_hint(s->bs) == BDRV_TYPE_CDROM) {
2613 s->is_cdrom = 1;
2614 bdrv_set_change_cb(s->bs, cdrom_change_cb, s);
2615 }
2616 strncpy(s->drive_serial_str, drive_get_serial(s->bs),
2617 sizeof(s->drive_serial_str));
2618 }
2619 if (strlen(s->drive_serial_str) == 0)
2620 snprintf(s->drive_serial_str, sizeof(s->drive_serial_str),
2621 "QM%05d", s->drive_serial);
2622 ide_reset(s);
2623}
2624
f455e98c 2625void ide_init2(IDEBus *bus, DriveInfo *hd0, DriveInfo *hd1,
356721ae 2626 qemu_irq irq)
5391d806 2627{
69b91039 2628 IDEState *s;
aedf5382 2629 static int drive_serial = 1;
88804180 2630 int i;
5391d806 2631
caed8802 2632 for(i = 0; i < 2; i++) {
bcbdc4d3
GH		 2633 s = bus->ifs + i;
2634 s->bus = bus;
2635 s->unit = i;
aedf5382 2636 s->drive_serial = drive_serial++;
88804180
GH		 2637 s->io_buffer = qemu_blockalign(s->bs, IDE_DMA_BUF_SECTORS*512 + 4);
2638 s->smart_selftest_data = qemu_blockalign(s->bs, 512);
5fafdf24 2639 s->sector_write_timer = qemu_new_timer(vm_clock,
a09db21f 2640 ide_sector_write_timer_cb, s);
88804180
GH		 2641 if (i == 0)
2642 ide_init_drive(s, hd0);
2643 if (i == 1)
2644 ide_init_drive(s, hd1);
5391d806 2645 }
9cdd03a7 2646 bus->irq = irq;
69b91039
FB		 2647}
2648
356721ae 2649void ide_init_ioport(IDEBus *bus, int iobase, int iobase2)
69b91039 2650{
bcbdc4d3
GH		 2651 register_ioport_write(iobase, 8, 1, ide_ioport_write, bus);
2652 register_ioport_read(iobase, 8, 1, ide_ioport_read, bus);
caed8802 2653 if (iobase2) {
bcbdc4d3
GH		 2654 register_ioport_read(iobase2, 1, 1, ide_status_read, bus);
2655 register_ioport_write(iobase2, 1, 1, ide_cmd_write, bus);
5391d806 2656 }
3b46e624 2657
caed8802 2658 /* data ports */
bcbdc4d3
GH		 2659 register_ioport_write(iobase, 2, 2, ide_data_writew, bus);
2660 register_ioport_read(iobase, 2, 2, ide_data_readw, bus);
2661 register_ioport_write(iobase, 4, 4, ide_data_writel, bus);
2662 register_ioport_read(iobase, 4, 4, ide_data_readl, bus);
5391d806 2663}
69b91039 2664
37159f13 2665static bool is_identify_set(void *opaque, int version_id)
aa941b94 2666{
37159f13
JQ		 2667 IDEState *s = opaque;
2668
2669 return s->identify_set != 0;
2670}
2671
2672static int ide_drive_post_load(void *opaque, int version_id)
aa941b94 2673{
37159f13
JQ		 2674 IDEState *s = opaque;
2675
2676 if (version_id < 3) {
93c8cfd9 2677 if (s->sense_key == SENSE_UNIT_ATTENTION &&
37159f13 2678 s->asc == ASC_MEDIUM_MAY_HAVE_CHANGED) {
93c8cfd9 2679 s->cdrom_changed = 1;
37159f13 2680 }
93c8cfd9 2681 }
37159f13 2682 return 0;
aa941b94
AZ		 2683}
2684
37159f13
JQ		 2685const VMStateDescription vmstate_ide_drive = {
2686 .name = "ide_drive",
2687 .version_id = 3,
2688 .minimum_version_id = 0,
2689 .minimum_version_id_old = 0,
2690 .post_load = ide_drive_post_load,
2691 .fields = (VMStateField []) {
2692 VMSTATE_INT32(mult_sectors, IDEState),
2693 VMSTATE_INT32(identify_set, IDEState),
2694 VMSTATE_BUFFER_TEST(identify_data, IDEState, is_identify_set),
2695 VMSTATE_UINT8(feature, IDEState),
2696 VMSTATE_UINT8(error, IDEState),
2697 VMSTATE_UINT32(nsector, IDEState),
2698 VMSTATE_UINT8(sector, IDEState),
2699 VMSTATE_UINT8(lcyl, IDEState),
2700 VMSTATE_UINT8(hcyl, IDEState),
2701 VMSTATE_UINT8(hob_feature, IDEState),
2702 VMSTATE_UINT8(hob_sector, IDEState),
2703 VMSTATE_UINT8(hob_nsector, IDEState),
2704 VMSTATE_UINT8(hob_lcyl, IDEState),
2705 VMSTATE_UINT8(hob_hcyl, IDEState),
2706 VMSTATE_UINT8(select, IDEState),
2707 VMSTATE_UINT8(status, IDEState),
2708 VMSTATE_UINT8(lba48, IDEState),
2709 VMSTATE_UINT8(sense_key, IDEState),
2710 VMSTATE_UINT8(asc, IDEState),
2711 VMSTATE_UINT8_V(cdrom_changed, IDEState, 3),
2712 /* XXX: if a transfer is pending, we do not save it yet */
2713 VMSTATE_END_OF_LIST()
2714 }
2715};
2716
6521dc62
JQ		 2717const VMStateDescription vmstate_ide_bus = {
2718 .name = "ide_bus",
2719 .version_id = 1,
2720 .minimum_version_id = 1,
2721 .minimum_version_id_old = 1,
2722 .fields = (VMStateField []) {
2723 VMSTATE_UINT8(cmd, IDEBus),
2724 VMSTATE_UINT8(unit, IDEBus),
2725 VMSTATE_END_OF_LIST()
2726 }
2727};
2728
69b91039
FB		 2729/***********************************************************/
2730/* PCI IDE definitions */
2731
8ccad811 2732static void ide_dma_start(IDEState *s, BlockDriverCompletionFunc *dma_cb)
98087450 2733{
bcbdc4d3 2734 BMDMAState *bm = s->bus->bmdma;
98087450
FB		 2735 if(!bm)
2736 return;
bcbdc4d3 2737 bm->unit = s->unit;
98087450 2738 bm->dma_cb = dma_cb;
8ccad811
FB		 2739 bm->cur_prd_last = 0;
2740 bm->cur_prd_addr = 0;
2741 bm->cur_prd_len = 0;
428c5705
AL		 2742 bm->sector_num = ide_get_sector(s);
2743 bm->nsector = s->nsector;
98087450 2744 if (bm->status & BM_STATUS_DMAING) {
8ccad811 2745 bm->dma_cb(bm, 0);
98087450
FB		 2746 }
2747}
2748
ce4b6522 2749static void ide_dma_restart(IDEState *s, int is_read)
428c5705 2750{
bcbdc4d3 2751 BMDMAState *bm = s->bus->bmdma;
428c5705
AL		 2752 ide_set_sector(s, bm->sector_num);
2753 s->io_buffer_index = 0;
2754 s->io_buffer_size = 0;
2755 s->nsector = bm->nsector;
2756 bm->cur_addr = bm->addr;
ce4b6522
KW		 2757
2758 if (is_read) {
2759 bm->dma_cb = ide_read_dma_cb;
2760 } else {
2761 bm->dma_cb = ide_write_dma_cb;
2762 }
2763
428c5705
AL		 2764 ide_dma_start(s, bm->dma_cb);
2765}
2766
356721ae 2767void ide_dma_cancel(BMDMAState *bm)
72c7b06c
AL		 2768{
2769 if (bm->status & BM_STATUS_DMAING) {
2770 bm->status &= ~BM_STATUS_DMAING;
2771 /* cancel DMA request */
bcbdc4d3 2772 bm->unit = -1;
72c7b06c
AL		 2773 bm->dma_cb = NULL;
2774 if (bm->aiocb) {
2775#ifdef DEBUG_AIO
2776 printf("aio_cancel\n");
2777#endif
2778 bdrv_aio_cancel(bm->aiocb);
2779 bm->aiocb = NULL;
2780 }
2781 }
2782}
2783
4a643563
BS		 2784void ide_dma_reset(BMDMAState *bm)
2785{
2786#ifdef DEBUG_IDE
2787 printf("ide: dma_reset\n");
2788#endif
2789 ide_dma_cancel(bm);
2790 bm->cmd = 0;
2791 bm->status = 0;
2792 bm->addr = 0;
2793 bm->cur_addr = 0;
2794 bm->cur_prd_last = 0;
2795 bm->cur_prd_addr = 0;
2796 bm->cur_prd_len = 0;
2797 bm->sector_num = 0;
2798 bm->nsector = 0;
2799}
Empty description
This page took 0.850237 seconds and 4 git commands to generate.