From 08fe4cf4e2da1d0a35c096804f3fc34572b1bd79 Mon Sep 17 00:00:00 2001
From: David du Colombier <0intro@gmail.com>
Date: Wed, 7 Oct 1992 00:00:00 +0000
Subject: [PATCH] Plan 9 from Bell Labs 1992-10-07

---
 pc/devfloppy.c | 30 ++++++++++++++++++------------
 1 file changed, 18 insertions(+), 12 deletions(-)

diff --git a/pc/devfloppy.c b/pc/devfloppy.c
index 2fdaa46dcf60647eed4d039640ccb7b9456c7be5..0a5645418e9e7056b353f61d809558557035ecd5 100644
--- a/pc/devfloppy.c
+++ b/pc/devfloppy.c
@@ -194,7 +194,7 @@ static long	floppyseek(Drive*, long);
 static int	floppysense(void);
 static void	floppywait(void);
 static long	floppyxfer(Drive*, int, void*, long, long);
-static int	floppyformat(Chan*, Drive*, int, char);
+static int	floppyformat(Drive*, ulong, ulong);
 static long	floppythrice(Drive*, int, void*, long, long);
 static int	cmddone(void*);
 void Xdelay(int);
@@ -460,7 +460,7 @@ floppyread(Chan *c, void *a, long n)
 
 		break;
 	case Qctl:
-		break;
+		return readstr(offset, a, n, dp->t->name);
 	default:
 		panic("floppyread: bad qid");
 	}
@@ -505,6 +505,10 @@ floppywrite(Chan *c, void *a, long n)
 		break;
 	case Qctl:
 		qlock(&fl);
+		if(waserror()){
+			qunlock(&fl);
+			nexterror();
+		}
 		if(n >= sizeof(ctlmsg))
 			n = sizeof(ctlmsg) - 1;
 		memmove(ctlmsg, aa, n);
@@ -517,8 +521,9 @@ floppywrite(Chan *c, void *a, long n)
 		} else if(SNCMP(ctlmsg, "format") == 0){
 			if(getfields(ctlmsg, f, 3, ' ') != 3)
 				error(Ebadarg);
-			rv = n*floppyformat(c, dp, atoi(f[1]), *f[2]);
+			rv = n*floppyformat(dp, strtoul(f[1], 0, 0), strtoul(f[2], 0, 0));
 		}
+		poperror();
 		qunlock(&fl);
 		break;
 	default:
@@ -952,7 +957,7 @@ floppyxfer(Drive *dp, int cmd, void *a, long off, long n)
  *  format a track
  */
 static int
-floppyformat(Chan *c, Drive *dp, int track, char filler)
+floppyformat(Drive *dp, ulong track, ulong filler)
 {
  	int cyl, h, sec;
 	uchar *buf, *bp;
@@ -963,18 +968,19 @@ floppyformat(Chan *c, Drive *dp, int track, char filler)
 	h = track % t->heads;
 	if(track >= t->tracks * t->heads)
 		return 0;
+	setdef(dp);
 	buf = smalloc(t->sectors*4);
-
-	qlock(&fl);
 	if(waserror()){
-		qunlock(&fl);
 		free(buf);
 		nexterror();
 	}
-	floppyon(dp);
-	changed(c, dp);
-	if(floppyseek(dp, track*t->tsize) < 0)
-		error(Eio);
+	if(!waserror()){
+		floppyon(dp);
+		poperror();
+	}
+	floppyseek(dp, track*t->tsize);
+	dp->cyl = cyl;
+	dp->confused = 0;
 
 	/*
 	 *  set up the dma (dp->len may be trimmed)
@@ -1023,8 +1029,8 @@ floppyformat(Chan *c, Drive *dp, int track, char filler)
 		dp->confused = 1;
 		error(Eio);
 	}
-	qunlock(&fl);
 	free(buf);
+	poperror();
 	return 1;
 }