[syslinux:disklib] chain.c32, libcom32: Move write_sector() as disk_write_sector()

[syslinux-bot for Shao Miller]

Commit-ID:  86bf50325b73618cd67a67d5b9a1781877493c07
Gitweb:     http://syslinux.zytor.com/commit/86bf50325b73618cd67a67d5b9a1781877493c07
Author:     Shao Miller <shao.miller at yrdsb.edu.on.ca>
AuthorDate: Mon, 28 Jun 2010 02:14:08 -0400
Committer:  Shao Miller <shao.miller at yrdsb.edu.on.ca>
CommitDate: Sat, 10 Jul 2010 01:03:05 -0400

chain.c32, libcom32: Move write_sector() as disk_write_sector()

Moving portions of chain.c32 into libcom32.

Signed-off-by: Shao Miller <shao.miller at yrdsb.edu.on.ca>


---
 com32/include/syslinux/disk.h |    2 +
 com32/lib/syslinux/disk.c     |   69 +++++++++++++++++++++++++++++++++++++++++
 com32/modules/chain.c         |   59 +----------------------------------
 3 files changed, 72 insertions(+), 58 deletions(-)

diff --git a/com32/include/syslinux/disk.h b/com32/include/syslinux/disk.h
index b6cdef0..ef002e2 100644
--- a/com32/include/syslinux/disk.h
+++ b/com32/include/syslinux/disk.h
@@ -61,5 +61,7 @@ extern int disk_int13_retry(const com32sys_t * inreg, com32sys_t * outreg);
 extern int disk_get_params(int disk, struct disk_info *diskinfo);
 extern void *disk_read_sectors(struct disk_info *diskinfo, uint64_t lba,
 			       uint8_t count);
+extern int disk_write_sector(struct disk_info *diskinfo, unsigned int lba,
+			     const void *data);
 
 #endif /* _SYSLINUX_DISK_H */
diff --git a/com32/lib/syslinux/disk.c b/com32/lib/syslinux/disk.c
index a1d6697..7b7cbe4 100644
--- a/com32/lib/syslinux/disk.c
+++ b/com32/lib/syslinux/disk.c
@@ -185,3 +185,72 @@ void *disk_read_sectors(struct disk_info *diskinfo, uint64_t lba, uint8_t count)
 	memcpy(data, buf, count * SECTOR);
     return data;
 }
+
+/**
+ * Write a disk block.
+ *
+ * @v diskinfo			The disk drive to write to
+ * @v lba			The logical block address to begin writing at
+ * @v data			The data to write
+ * @ret (int)			0 upon success, -1 upon failure
+ *
+ * Uses the disk number and information from diskinfo.
+ * Write a sector to a disk drive, starting at lba.
+ */
+int disk_write_sector(struct disk_info *diskinfo, unsigned int lba,
+		      const void *data)
+{
+    com32sys_t inreg;
+    struct disk_ebios_dapa *dapa = __com32.cs_bounce;
+    void *buf = (char *)__com32.cs_bounce + SECTOR;
+
+    memcpy(buf, data, SECTOR);
+    memset(&inreg, 0, sizeof inreg);
+
+    if (diskinfo->ebios) {
+	dapa->len = sizeof(*dapa);
+	dapa->count = 1;	/* 1 sector */
+	dapa->off = OFFS(buf);
+	dapa->seg = SEG(buf);
+	dapa->lba = lba;
+
+	inreg.esi.w[0] = OFFS(dapa);
+	inreg.ds = SEG(dapa);
+	inreg.edx.b[0] = diskinfo->disk;
+	inreg.eax.w[0] = 0x4300;	/* Extended write */
+    } else {
+	unsigned int c, h, s, t;
+
+	if (!diskinfo->cbios) {
+	    /* We failed to get the geometry */
+
+	    if (lba)
+		return -1;	/* Can only write MBR */
+
+	    s = 1;
+	    h = 0;
+	    c = 0;
+	} else {
+	    s = (lba % diskinfo->sect) + 1;
+	    t = lba / diskinfo->sect;	/* Track = head*cyl */
+	    h = t % diskinfo->head;
+	    c = t / diskinfo->head;
+	}
+
+	if (s > 63 || h > 256 || c > 1023)
+	    return -1;
+
+	inreg.eax.w[0] = 0x0301;	/* Write one sector */
+	inreg.ecx.b[1] = c & 0xff;
+	inreg.ecx.b[0] = s + (c >> 6);
+	inreg.edx.b[1] = h;
+	inreg.edx.b[0] = diskinfo->disk;
+	inreg.ebx.w[0] = OFFS(buf);
+	inreg.es = SEG(buf);
+    }
+
+    if (disk_int13_retry(&inreg, NULL))
+	return -1;
+
+    return 0;			/* ok */
+}
diff --git a/com32/modules/chain.c b/com32/modules/chain.c
index 0ff1ea1..de827a2 100644
--- a/com32/modules/chain.c
+++ b/com32/modules/chain.c
@@ -147,69 +147,12 @@ static inline void error(const char *msg)
 
 static struct disk_info diskinfo;
 
-static int write_sector(unsigned int lba, const void *data)
-{
-    com32sys_t inreg;
-    struct disk_ebios_dapa *dapa = __com32.cs_bounce;
-    void *buf = (char *)__com32.cs_bounce + SECTOR;
-
-    memcpy(buf, data, SECTOR);
-    memset(&inreg, 0, sizeof inreg);
-
-    if (diskinfo.ebios) {
-	dapa->len = sizeof(*dapa);
-	dapa->count = 1;	/* 1 sector */
-	dapa->off = OFFS(buf);
-	dapa->seg = SEG(buf);
-	dapa->lba = lba;
-
-	inreg.esi.w[0] = OFFS(dapa);
-	inreg.ds = SEG(dapa);
-	inreg.edx.b[0] = diskinfo.disk;
-	inreg.eax.w[0] = 0x4300;	/* Extended write */
-    } else {
-	unsigned int c, h, s, t;
-
-	if (!diskinfo.cbios) {
-	    /* We failed to get the geometry */
-
-	    if (lba)
-		return -1;	/* Can only write MBR */
-
-	    s = 1;
-	    h = 0;
-	    c = 0;
-	} else {
-	    s = (lba % diskinfo.sect) + 1;
-	    t = lba / diskinfo.sect;	/* Track = head*cyl */
-	    h = t % diskinfo.head;
-	    c = t / diskinfo.head;
-	}
-
-	if (s > 63 || h > 256 || c > 1023)
-	    return -1;
-
-	inreg.eax.w[0] = 0x0301;	/* Write one sector */
-	inreg.ecx.b[1] = c & 0xff;
-	inreg.ecx.b[0] = s + (c >> 6);
-	inreg.edx.b[1] = h;
-	inreg.edx.b[0] = diskinfo.disk;
-	inreg.ebx.w[0] = OFFS(buf);
-	inreg.es = SEG(buf);
-    }
-
-    if (disk_int13_retry(&inreg, NULL))
-	return -1;
-
-    return 0;			/* ok */
-}
-
 static int write_verify_sector(unsigned int lba, const void *buf)
 {
     char *rb;
     int rv;
 
-    rv = write_sector(lba, buf);
+    rv = disk_write_sector(&diskinfo, lba, buf);
     if (rv)
 	return rv;		/* Write failure */
     rb = disk_read_sectors(&diskinfo, lba, 1);