From b0f0c1de18ceaa46d64b56da586984fd8ed8f6cb Mon Sep 17 00:00:00 2001
From: Natalia Portillo <claunia@claunia.com>
Date: Fri, 27 Mar 2020 19:17:18 +0000
Subject: [PATCH] Implement FORMAT UNIT for magneto-optical disks.

---
 src/devices/disk/mo.c | 77 +++++++++++++++++++++++++++++++++++++++++++
 src/devices/disk/mo.h |  1 +
 2 files changed, 78 insertions(+)

diff --git a/src/devices/disk/mo.c b/src/devices/disk/mo.c
index 849045f..f6fd47e 100644
--- a/src/devices/disk/mo.c
+++ b/src/devices/disk/mo.c
@@ -56,6 +56,11 @@
 #include "../disk/hdc_ide.h"
 #include "mo.h"
 
+#ifdef _WIN32
+#include <windows.h>
+#else
+#include <unistd.h>
+#endif
 
 /* Bits of 'status' */
 #define ERR_STAT		0x01
@@ -1281,6 +1286,7 @@ do_command(void *p, uint8_t *cdb)
 			return;
 		}
 
+		mo_format(dev);
 		set_phase(dev, SCSI_PHASE_STATUS);
 		command_complete(dev);
 		break;
@@ -2764,3 +2770,74 @@ mo_insert(mo_t *dev)
 {
     dev->unit_attention = 1;
 }
+
+
+void
+mo_format(mo_t *dev)
+{
+	long size;
+	int ret;
+	int fd;
+
+	DEBUG("Formatting media...\n");
+
+	fseek(dev->drv->f, 0, SEEK_END);
+	size = ftell(dev->drv->f);
+
+#ifdef _WIN32
+	HANDLE fh;
+
+	fd = _fileno(dev->drv->f);
+	fh = (HANDLE)_get_osfhandle(fd);
+
+	ret = (int)SetFilePointerEx(fh, 0, NULL, FILE_BEGIN);
+
+	if(!ret)
+	{
+		DEBUG("MO %i: Failed seek to start of image file\n", dev->id);
+		return;
+	}
+
+	ret = (int)SetEndOfFile(fh);
+
+	if(ret)
+	{
+		DEBUG("MO %i: Failed to truncate image file to 0\n", dev->id);
+		return;
+	}
+
+	ret = (int)SetFilePointerEx(fh, size, NULL, FILE_BEGIN);
+
+	if(!ret)
+	{
+		DEBUG("MO %i: Failed seek to end of image file\n", dev->id);
+		return;
+	}
+
+	ret = (int)SetEndOfFile(fh);
+
+	if(ret)
+	{
+		DEBUG("MO %i: Failed to truncate image file to %llu\n", dev->id, size);
+		return;
+	}
+#else
+	fd = fileno(dev->drv->f);
+
+	ret = ftruncate(fd, 0);
+
+	if(ret)
+	{
+		DEBUG("MO %i: Failed to truncate image file to 0\n", dev->id);
+		return;
+	}
+
+	ret = ftruncate(fd, size);
+
+	if(ret)
+	{
+		DEBUG("MO %i: Failed to truncate image file to %llu", dev->id, size);
+		return;
+	}
+#endif
+}
diff --git a/src/devices/disk/mo.h b/src/devices/disk/mo.h
index 117b49d..09fda95 100644
--- a/src/devices/disk/mo.h
+++ b/src/devices/disk/mo.h
@@ -144,6 +144,7 @@ extern int		   mo_string_to_bus(const char *str);
 extern const char *mo_bus_to_string(int bus);
 extern int	       mo_load(mo_t *dev, const wchar_t *fn);
 extern void	       mo_close(void);
+extern void        mo_format(mo_t *dev);
 
 #ifdef __cplusplus
 }