ide-test: test trim requests
Signed-off-by: Anton Nefedov <anton.nefedov@virtuozzo.com> Reviewed-by: John Snow <jsnow@redhat.com> Message-id: 1516611841-5526-1-git-send-email-anton.nefedov@virtuozzo.com Signed-off-by: John Snow <jsnow@redhat.com>
This commit is contained in:
parent
0833df03f4
commit
29e1d473cc
@ -52,6 +52,7 @@
|
||||
enum {
|
||||
reg_data = 0x0,
|
||||
reg_feature = 0x1,
|
||||
reg_error = 0x1,
|
||||
reg_nsectors = 0x2,
|
||||
reg_lba_low = 0x3,
|
||||
reg_lba_middle = 0x4,
|
||||
@ -69,6 +70,11 @@ enum {
|
||||
ERR = 0x01,
|
||||
};
|
||||
|
||||
/* Error field */
|
||||
enum {
|
||||
ABRT = 0x04,
|
||||
};
|
||||
|
||||
enum {
|
||||
DEV = 0x10,
|
||||
LBA = 0x40,
|
||||
@ -81,6 +87,7 @@ enum {
|
||||
};
|
||||
|
||||
enum {
|
||||
CMD_DSM = 0x06,
|
||||
CMD_READ_DMA = 0xc8,
|
||||
CMD_WRITE_DMA = 0xca,
|
||||
CMD_FLUSH_CACHE = 0xe7,
|
||||
@ -179,6 +186,12 @@ typedef struct PrdtEntry {
|
||||
#define assert_bit_set(data, mask) g_assert_cmphex((data) & (mask), ==, (mask))
|
||||
#define assert_bit_clear(data, mask) g_assert_cmphex((data) & (mask), ==, 0)
|
||||
|
||||
static uint64_t trim_range_le(uint64_t sector, uint16_t count)
|
||||
{
|
||||
/* 2-byte range, 6-byte LBA */
|
||||
return cpu_to_le64(((uint64_t)count << 48) + sector);
|
||||
}
|
||||
|
||||
static int send_dma_request(int cmd, uint64_t sector, int nb_sectors,
|
||||
PrdtEntry *prdt, int prdt_entries,
|
||||
void(*post_exec)(QPCIDevice *dev, QPCIBar ide_bar,
|
||||
@ -204,6 +217,7 @@ static int send_dma_request(int cmd, uint64_t sector, int nb_sectors,
|
||||
* the SCSI command being sent in the packet, too. */
|
||||
from_dev = true;
|
||||
break;
|
||||
case CMD_DSM:
|
||||
case CMD_WRITE_DMA:
|
||||
from_dev = false;
|
||||
break;
|
||||
@ -234,6 +248,10 @@ static int send_dma_request(int cmd, uint64_t sector, int nb_sectors,
|
||||
/* Enables ATAPI DMA; otherwise PIO is attempted */
|
||||
qpci_io_writeb(dev, ide_bar, reg_feature, 0x01);
|
||||
} else {
|
||||
if (cmd == CMD_DSM) {
|
||||
/* trim bit */
|
||||
qpci_io_writeb(dev, ide_bar, reg_feature, 0x01);
|
||||
}
|
||||
qpci_io_writeb(dev, ide_bar, reg_nsectors, nb_sectors);
|
||||
qpci_io_writeb(dev, ide_bar, reg_lba_low, sector & 0xff);
|
||||
qpci_io_writeb(dev, ide_bar, reg_lba_middle, (sector >> 8) & 0xff);
|
||||
@ -344,6 +362,58 @@ static void test_bmdma_simple_rw(void)
|
||||
g_free(cmpbuf);
|
||||
}
|
||||
|
||||
static void test_bmdma_trim(void)
|
||||
{
|
||||
QPCIDevice *dev;
|
||||
QPCIBar bmdma_bar, ide_bar;
|
||||
uint8_t status;
|
||||
const uint64_t trim_range[] = { trim_range_le(0, 2),
|
||||
trim_range_le(6, 8),
|
||||
trim_range_le(10, 1),
|
||||
};
|
||||
const uint64_t bad_range = trim_range_le(TEST_IMAGE_SIZE / 512 - 1, 2);
|
||||
size_t len = 512;
|
||||
uint8_t *buf;
|
||||
uintptr_t guest_buf = guest_alloc(guest_malloc, len);
|
||||
|
||||
PrdtEntry prdt[] = {
|
||||
{
|
||||
.addr = cpu_to_le32(guest_buf),
|
||||
.size = cpu_to_le32(len | PRDT_EOT),
|
||||
},
|
||||
};
|
||||
|
||||
dev = get_pci_device(&bmdma_bar, &ide_bar);
|
||||
|
||||
buf = g_malloc(len);
|
||||
|
||||
/* Normal request */
|
||||
*((uint64_t *)buf) = trim_range[0];
|
||||
*((uint64_t *)buf + 1) = trim_range[1];
|
||||
|
||||
memwrite(guest_buf, buf, 2 * sizeof(uint64_t));
|
||||
|
||||
status = send_dma_request(CMD_DSM, 0, 1, prdt,
|
||||
ARRAY_SIZE(prdt), NULL);
|
||||
g_assert_cmphex(status, ==, BM_STS_INTR);
|
||||
assert_bit_clear(qpci_io_readb(dev, ide_bar, reg_status), DF | ERR);
|
||||
|
||||
/* Request contains invalid range */
|
||||
*((uint64_t *)buf) = trim_range[2];
|
||||
*((uint64_t *)buf + 1) = bad_range;
|
||||
|
||||
memwrite(guest_buf, buf, 2 * sizeof(uint64_t));
|
||||
|
||||
status = send_dma_request(CMD_DSM, 0, 1, prdt,
|
||||
ARRAY_SIZE(prdt), NULL);
|
||||
g_assert_cmphex(status, ==, BM_STS_INTR);
|
||||
assert_bit_set(qpci_io_readb(dev, ide_bar, reg_status), ERR);
|
||||
assert_bit_set(qpci_io_readb(dev, ide_bar, reg_error), ABRT);
|
||||
|
||||
free_pci_device(dev);
|
||||
g_free(buf);
|
||||
}
|
||||
|
||||
static void test_bmdma_short_prdt(void)
|
||||
{
|
||||
QPCIDevice *dev;
|
||||
@ -963,6 +1033,7 @@ int main(int argc, char **argv)
|
||||
|
||||
qtest_add_func("/ide/bmdma/setup", test_bmdma_setup);
|
||||
qtest_add_func("/ide/bmdma/simple_rw", test_bmdma_simple_rw);
|
||||
qtest_add_func("/ide/bmdma/trim", test_bmdma_trim);
|
||||
qtest_add_func("/ide/bmdma/short_prdt", test_bmdma_short_prdt);
|
||||
qtest_add_func("/ide/bmdma/one_sector_short_prdt",
|
||||
test_bmdma_one_sector_short_prdt);
|
||||
|
Loading…
Reference in New Issue
Block a user