1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
/*
* Intel AMT IDE redirection protocol helper functions.
*
* Copyright (C) 2022 Hannes Reinecke <hare@suse.de>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdbool.h>
#include <sys/types.h>
#include <scsi/scsi.h>
#include "redir.h"
static int ider_data_to_host(struct redir *r, unsigned int seqno,
unsigned char *data, unsigned int data_len,
bool completed)
{
unsigned char device = 0xb0;
unsigned char *request;
int ret;
unsigned char mask = IDER_STATUS_MASK | IDER_SECTOR_COUNT_MASK |
IDER_INTERRUPT_MASK;
struct ider_data_to_host_message msg = {
.type = IDER_DATA_TO_HOST,
.attributes = completed ? 2 : 0,
.input.mask = mask | IDER_BYTE_CNT_LSB_MASK | IDER_BYTE_CNT_MSB_MASK,
.input.sector_count = IDER_INTERRUPT_IO,
.input.byte_count_lsb = (data_len & 0xff),
.input.byte_count_msb = (data_len >> 8) & 0xff,
.input.drive_select = device,
.input.status = IDER_STATUS_DRDY | IDER_STATUS_DSC | IDER_STATUS_DRQ,
.output.mask = mask,
.output.sector_count = IDER_INTERRUPT_CD | IDER_INTERRUPT_CD,
.output.drive_select = device,
.output.status = IDER_STATUS_DRDY | IDER_STATUS_DSC,
};
memcpy(&msg.transfer_bytes, &data_len, 2);
memcpy(&msg.sequence_number, &seqno, 4);
request = malloc(sizeof(msg) + data_len);
memcpy(request, &msg, sizeof(msg));
memcpy(request + sizeof(msg), data, data_len);
ret = redir_write(r, request, sizeof(msg) + data_len);
free(request);
return ret;
}
static int ider_packet_sense(struct redir *r, unsigned int seqno,
unsigned char device, unsigned char sense,
unsigned char asc, unsigned char asq)
{
unsigned char mask = IDER_INTERRUPT_MASK | IDER_SECTOR_COUNT_MASK |
IDER_DRIVE_SELECT_MASK | IDER_STATUS_MASK;
struct ider_command_response_message msg = {
.type = IDER_COMMAND_END_RESPONSE,
.attributes = 2,
.output.mask = mask,
.output.sector_count = IDER_INTERRUPT_IO | IDER_INTERRUPT_CD,
.output.drive_select = device,
.output.status = IDER_STATUS_DRDY | IDER_STATUS_DSC,
};
memcpy(&msg.sequence_number, &seqno, 4);
if (sense) {
msg.output.error = (sense << 4);
msg.output.mask |= IDER_ERROR_MASK;
msg.output.status |= IDER_STATUS_ERR;
msg.sense = sense;
msg.asc = asc;
msg.asq = asq;
}
return redir_write(r, (const char *)&msg, sizeof(msg));
}
int ider_handle_command(struct redir *r, unsigned int seqno,
unsigned char device, unsigned char *cdb)
{
unsigned char resp[512];
uint32_t lba, sector_size;
if (!r->mmap_size)
/* NOT READY, MEDIUM NOT PRESENT */
return ider_packet_sense(r, seqno, device, 0x02, 0x3a, 0x0);
switch (cdb[0]) {
case TEST_UNIT_READY:
return ider_packet_sense(r, seqno, device, 0, 0, 0);
case MODE_SENSE:
if (cdb[2] != 0x3f || cdb[3] != 0x00)
return ider_packet_sense(r, seqno, device, 0x05, 0x24, 0x00);
resp[0] = 0; /* Mode data length */
resp[1] = 0x05; /* Medium type: CD-ROM data only */
resp[2] = 0x80; /* device-specific parameters: Write Protect */
resp[3] = 0; /* Block-descriptor length */
return ider_data_to_host(r, seqno, resp, 4, true);
case READ_CAPACITY:
lba = (r->mmap_size >> 11) - 1;
sector_size = (unsigned int)1 << 11;
resp[0] = (lba >> 24) & 0xff;
resp[1] = (lba >> 16) & 0xff;
resp[2] = (lba >> 8) & 0xff;
resp[3] = lba & 0xff;
resp[4] = (sector_size >> 24) & 0xff;
resp[5] = (sector_size >> 16) & 0xff;
resp[6] = (sector_size >> 8) & 0xff;
resp[7] = sector_size & 0xff;
return ider_data_to_host(r, seqno, resp, 8, true);
default:
break;
}
fprintf(stderr, "seqno %u: unhandled command %02x\n", seqno, cdb[0]);
/* ILLEGAL REQUEST, CDB NOT SUPPORTED */
return ider_packet_sense(r, seqno, device, 0x05, 0x20, 0x00);
}
|
