From a1f94a0abc1858139653d13c421ebe35c40cb569 Mon Sep 17 00:00:00 2001
From: sorgelig <pour.garbage@gmail.com>
Date: Tue, 6 Jul 2021 23:57:28 +0800
Subject: [PATCH] IDE: fix cylinders on headerless HDF. Fix completion CHS
 value.

---
 ide.cpp | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/ide.cpp b/ide.cpp
index b6c7e6c..aa2719f 100644
--- a/ide.cpp
+++ b/ide.cpp
@@ -187,6 +187,11 @@ static void ide_set_geometry(drive_t *drive, uint16_t sectors, uint16_t heads)
 	drive->spt = sectors ? sectors : 256;
 
 	uint32_t cylinders = drive->f->size / (drive->heads * drive->spt * 512);
+	if (drive->offset)
+	{
+		cylinders++;
+		drive->offset = drive->heads * drive->spt;
+	}
 	if (cylinders > 65535) cylinders = 65535;
 
 	//Maximum 137GB images are supported.
@@ -594,6 +599,8 @@ static uint32_t get_lba(ide_config *ide)
 
 static void put_lba(ide_config *ide, uint32_t lba)
 {
+	lba--;
+	dbg2_printf("  putLBA: %u\n", lba);
 	if (ide->regs.lba)
 	{
 		ide->regs.sector = lba;