CVS: blob/src/lib ide.c,1.6,1.7

[Stefan E. <se...@us...>]

Update of /cvsroot/blob/blob/src/lib
In directory usw-pr-cvs1:/tmp/cvs-serv11822

Modified Files:
	ide.c 
Log Message:
- lba read


Index: ide.c
===================================================================
RCS file: /cvsroot/blob/blob/src/lib/ide.c,v
retrieving revision 1.6
retrieving revision 1.7
diff -u -d -r1.6 -r1.7
--- ide.c	8 May 2002 19:16:04 -0000	1.6
+++ ide.c	10 May 2002 15:33:39 -0000	1.7
@@ -345,6 +345,69 @@
 }
 
 /**********************************************************************
+ * hd_read_lba
+ * - read using LBA mode
+ */
+int hd_read_lba( ide_drive_t *drive, u32 lba, char *buffer)
+{
+	int i, hd_drive;
+	u8 status, hd_cmd[8];
+	volatile u8 *port = NULL;
+	volatile u8 *reg = NULL;
+
+	if ( !drive || !drive->ide_port )
+		return -1;
+
+	port = drive->ide_port;
+	reg = drive->ide_reg;
+
+	lba &= 0x0fffffff;
+
+	hd_drive = 0;
+
+	hd_cmd[1] = 0;
+	hd_cmd[2] = 1;			/* # sectors */
+	hd_cmd[3] = lba&0xff;
+	hd_cmd[4] = (lba>>8)&0xff;
+	hd_cmd[5] = (lba>>16)&0xff;
+	hd_cmd[6] = (lba>>24)&0xff;
+	hd_cmd[6] |= ((hd_drive&1) << 4) | 0xe0;
+
+	hd_busy_wait(port);
+
+	for (i = 1; i < 7; i++) {
+		port[i] = hd_cmd[i];
+		barrier();
+	}
+
+	port[7] = HDC_READ;
+	barrier();
+
+	hd_busy_wait(port);
+
+	for (i = 0; i < IDE_BLOCK_SIZE; i++) {
+		buffer[i] = port[0];
+		barrier();
+	}
+
+	drive->last_status = status = port[7];
+
+	if (status & ERROR) {
+		printf("hd_read_lba: read status: %2x\n", status);
+
+		printf("hd_read_lba: lba=%08x\n", lba&0x0fffffff );
+		for (i = 1; i < 7; i++) {
+			printf("hd_cmd[%d] %2x\n", i, hd_cmd[i]);
+		}
+	}
+
+	if (status & ERROR)
+		return -1;
+
+	return 0;
+}
+
+/**********************************************************************
  * hd_read_mapped
  *
  * - reads 512 bytes from sector <sector_num> from drive <drive>