fix: free the alloced dma memory when we done the io test
-hba_alloc_slot(struct hba_port* port,
- struct hba_cmdt** cmdt,
- struct hba_cmdh** cmdh,
- uint16_t header_options)
+hba_prepare_cmd(struct hba_port* port,
+ struct hba_cmdt** cmdt,
+ struct hba_cmdh** cmdh,
+ void* buffer,
+ unsigned int size)
{
int slot = __get_free_slot(port);
assert_msg(slot >= 0, "HBA: No free slot");
{
int slot = __get_free_slot(port);
assert_msg(slot >= 0, "HBA: No free slot");
+ assert_msg(size <= 0x400000, "HBA: buffer too big");
// 构建命令头(Command Header)和命令表(Command Table)
struct hba_cmdh* cmd_header = &port->cmdlst[slot];
// 构建命令头(Command Header)和命令表(Command Table)
struct hba_cmdh* cmd_header = &port->cmdlst[slot];
// 将命令表挂到命令头上
cmd_header->cmd_table_base = vmm_v2p(cmd_table);
// 将命令表挂到命令头上
cmd_header->cmd_table_base = vmm_v2p(cmd_table);
- cmd_header->options = HBA_CMDH_FIS_LEN(sizeof(struct sata_reg_fis)) |
- HBA_CMDH_CLR_BUSY | (header_options & ~0x1f);
+ cmd_header->options =
+ HBA_CMDH_FIS_LEN(sizeof(struct sata_reg_fis)) | HBA_CMDH_CLR_BUSY;
+
+ if (buffer) {
+ cmd_header->prdt_len = 1;
+ cmd_table->entries[0] =
+ (struct hba_prdte){ .data_base = vmm_v2p(buffer),
+ .byte_count = size - 1 };
+ }
*cmdh = cmd_header;
*cmdt = cmd_table;
*cmdh = cmd_header;
*cmdt = cmd_table;
// 确保端口是空闲的
wait_until(!(port->regs[HBA_RPxTFD] & (HBA_PxTFD_BSY)));
// 确保端口是空闲的
wait_until(!(port->regs[HBA_RPxTFD] & (HBA_PxTFD_BSY)));
- int slot = hba_alloc_slot(port, &cmd_table, &cmd_header, 0);
+ // 预备DMA接收缓存,用于存放HBA传回的数据
+ uint16_t* data_in = (uint16_t*)valloc_dma(512);
+
+ int slot = hba_prepare_cmd(port, &cmd_table, &cmd_header, data_in, 512);
// 清空任何待响应的中断
port->regs[HBA_RPxIS] = 0;
port->device = vcalloc(sizeof(struct hba_device));
// 清空任何待响应的中断
port->regs[HBA_RPxIS] = 0;
port->device = vcalloc(sizeof(struct hba_device));
- // 预备DMA接收缓存,用于存放HBA传回的数据
- uint16_t* data_in = (uint16_t*)valloc_dma(512);
-
- cmd_table->entries[0] =
- (struct hba_prdte){ .data_base = vmm_v2p(data_in),
- .byte_count = 511 }; // byte_count是从0开始算的
- cmd_header->prdt_len = 1;
-
// 在命令表中构建命令FIS
struct sata_reg_fis* cmd_fis = (struct sata_reg_fis*)cmd_table->command_fis;
// 在命令表中构建命令FIS
struct sata_reg_fis* cmd_fis = (struct sata_reg_fis*)cmd_table->command_fis;
struct hba_cmdh* header;
struct hba_cmdt* table;
struct hba_cmdh* header;
struct hba_cmdt* table;
- int slot = hba_alloc_slot(port, &table, &header, 0);
+ int slot = hba_prepare_cmd(port, &table, &header, buffer, size);
int bitmask = 1 << slot;
// 确保端口是空闲的
int bitmask = 1 << slot;
// 确保端口是空闲的
port->regs[HBA_RPxIS] = 0;
port->regs[HBA_RPxIS] = 0;
- table->entries[0] = (struct hba_prdte){ .byte_count = size - 1,
- .data_base = vmm_v2p(buffer) };
- header->prdt_len = 1;
header->options |= HBA_CMDH_WRITE * (write == 1);
uint16_t count = ICEIL(size, port->device->block_size);
header->options |= HBA_CMDH_WRITE * (write == 1);
uint16_t count = ICEIL(size, port->device->block_size);
{
uint32_t tfd = port->regs[HBA_RPxTFD];
port->device->last_error = (tfd >> 8) & 0xff;
{
uint32_t tfd = port->regs[HBA_RPxTFD];
port->device->last_error = (tfd >> 8) & 0xff;
+ port->device->last_status = tfd & 0xff;
}
\ No newline at end of file
}
\ No newline at end of file
struct hba_cmdh* header;
struct hba_cmdt* table;
struct hba_cmdh* header;
struct hba_cmdt* table;
- int slot = hba_alloc_slot(port, &table, &header, 0);
+ int slot = hba_prepare_cmd(port, &table, &header, buffer, size);
int bitmask = 1 << slot;
// 确保端口是空闲的
int bitmask = 1 << slot;
// 确保端口是空闲的
port->regs[HBA_RPxIS] = 0;
port->regs[HBA_RPxIS] = 0;
- table->entries[0] = (struct hba_prdte){ .byte_count = size - 1,
- .data_base = vmm_v2p(buffer) };
- header->prdt_len = 1;
header->options |= (HBA_CMDH_WRITE * (write == 1)) | HBA_CMDH_ATAPI;
uint32_t count = ICEIL(size, port->device->block_size);
header->options |= (HBA_CMDH_WRITE * (write == 1)) | HBA_CMDH_ATAPI;
uint32_t count = ICEIL(size, port->device->block_size);
write ? SCSI_WRITE_BLOCKS_16 : SCSI_READ_BLOCKS_16,
lba,
count);
write ? SCSI_WRITE_BLOCKS_16 : SCSI_READ_BLOCKS_16,
lba,
count);
- ((struct scsi_cdb16*)cdb)->misc1 = 3 << 5; // 禁用保护检查
} else {
scsi_create_packet12((struct scsi_cdb12*)cdb,
write ? SCSI_WRITE_BLOCKS_12 : SCSI_READ_BLOCKS_12,
lba,
count);
} else {
scsi_create_packet12((struct scsi_cdb12*)cdb,
write ? SCSI_WRITE_BLOCKS_12 : SCSI_READ_BLOCKS_12,
lba,
count);
- ((struct scsi_cdb12*)cdb)->misc1 = 3 << 5; // 禁用保护检查
+ // field: cdb->misc1
+ *((uint8_t*)cdb + 1) = 3 << 5; // RPROTECT=011b 禁用保护检查
+
int retries = 0;
while (retries < MAX_RETRY) {
int retries = 0;
while (retries < MAX_RETRY) {
-hba_alloc_slot(struct hba_port* port,
- struct hba_cmdt** cmdt,
- struct hba_cmdh** cmdh,
- uint16_t header_options);
+hba_prepare_cmd(struct hba_port* port,
+ struct hba_cmdt** cmdt,
+ struct hba_cmdh** cmdh,
+ void* buffer,
+ unsigned int size);
#endif /* __LUNAIX_HBA_H */
#endif /* __LUNAIX_HBA_H */
} else {
kprint_hex(buffer, 256);
}
} else {
kprint_hex(buffer, 256);
}