Commit b65f0755 authored by Mark Fortescue's avatar Mark Fortescue Committed by David S. Miller

[SPARC]: Fix floppy on some sun4c systems.

Add in code to support an 82077 FDC on sun4c systems. There is a
problem with spurious interrupts but it does apear to work.

Testing on my SS2 (82072A FDC) shows that the floppy driver is not
100% with sun4c any way (any spurious interrupt kills it, requiring a
reboot to recover).
Signed-off-by: default avatarMark Fortescue <mark@mtfhpc.demon.co.uk>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent a2d6ea01
...@@ -101,6 +101,29 @@ static struct sun_floppy_ops sun_fdops; ...@@ -101,6 +101,29 @@ static struct sun_floppy_ops sun_fdops;
#define CROSS_64KB(a,s) (0) #define CROSS_64KB(a,s) (0)
/* Routines unique to each controller type on a Sun. */ /* Routines unique to each controller type on a Sun. */
static void sun_set_dor(unsigned char value, int fdc_82077)
{
if (sparc_cpu_model == sun4c) {
unsigned int bits = 0;
if (value & 0x10)
bits |= AUXIO_FLPY_DSEL;
if ((value & 0x80) == 0)
bits |= AUXIO_FLPY_EJCT;
set_auxio(bits, (~bits) & (AUXIO_FLPY_DSEL|AUXIO_FLPY_EJCT));
}
if (fdc_82077) {
sun_fdc->dor_82077 = value;
}
}
static unsigned char sun_read_dir(void)
{
if (sparc_cpu_model == sun4c)
return (get_auxio() & AUXIO_FLPY_DCHG) ? 0x80 : 0;
else
return sun_fdc->dir_82077;
}
static unsigned char sun_82072_fd_inb(int port) static unsigned char sun_82072_fd_inb(int port)
{ {
udelay(5); udelay(5);
...@@ -113,7 +136,7 @@ static unsigned char sun_82072_fd_inb(int port) ...@@ -113,7 +136,7 @@ static unsigned char sun_82072_fd_inb(int port)
case 5: /* FD_DATA */ case 5: /* FD_DATA */
return sun_fdc->data_82072; return sun_fdc->data_82072;
case 7: /* FD_DIR */ case 7: /* FD_DIR */
return (get_auxio() & AUXIO_FLPY_DCHG)? 0x80: 0; return sun_read_dir();
}; };
panic("sun_82072_fd_inb: How did I get here?"); panic("sun_82072_fd_inb: How did I get here?");
} }
...@@ -126,20 +149,7 @@ static void sun_82072_fd_outb(unsigned char value, int port) ...@@ -126,20 +149,7 @@ static void sun_82072_fd_outb(unsigned char value, int port)
printk("floppy: Asked to write to unknown port %d\n", port); printk("floppy: Asked to write to unknown port %d\n", port);
panic("floppy: Port bolixed."); panic("floppy: Port bolixed.");
case 2: /* FD_DOR */ case 2: /* FD_DOR */
/* Oh geese, 82072 on the Sun has no DOR register, sun_set_dor(value, 0);
* the functionality is implemented via the AUXIO
* I/O register. So we must emulate the behavior.
*
* ASSUMPTIONS: There will only ever be one floppy
* drive attached to a Sun controller
* and it will be at drive zero.
*/
{
unsigned bits = 0;
if (value & 0x10) bits |= AUXIO_FLPY_DSEL;
if ((value & 0x80) == 0) bits |= AUXIO_FLPY_EJCT;
set_auxio(bits, (~bits) & (AUXIO_FLPY_DSEL|AUXIO_FLPY_EJCT));
}
break; break;
case 5: /* FD_DATA */ case 5: /* FD_DATA */
sun_fdc->data_82072 = value; sun_fdc->data_82072 = value;
...@@ -161,15 +171,22 @@ static unsigned char sun_82077_fd_inb(int port) ...@@ -161,15 +171,22 @@ static unsigned char sun_82077_fd_inb(int port)
default: default:
printk("floppy: Asked to read unknown port %d\n", port); printk("floppy: Asked to read unknown port %d\n", port);
panic("floppy: Port bolixed."); panic("floppy: Port bolixed.");
case 0: /* FD_STATUS_0 */
return sun_fdc->status1_82077;
case 1: /* FD_STATUS_1 */
return sun_fdc->status2_82077;
case 2: /* FD_DOR */
return sun_fdc->dor_82077;
case 3: /* FD_TDR */
return sun_fdc->tapectl_82077;
case 4: /* FD_STATUS */ case 4: /* FD_STATUS */
return sun_fdc->status_82077 & ~STATUS_DMA; return sun_fdc->status_82077 & ~STATUS_DMA;
case 5: /* FD_DATA */ case 5: /* FD_DATA */
return sun_fdc->data_82077; return sun_fdc->data_82077;
case 7: /* FD_DIR */ case 7: /* FD_DIR */
/* XXX: Is DCL on 0x80 in sun4m? */ return sun_read_dir();
return sun_fdc->dir_82077;
}; };
panic("sun_82072_fd_inb: How did I get here?"); panic("sun_82077_fd_inb: How did I get here?");
} }
static void sun_82077_fd_outb(unsigned char value, int port) static void sun_82077_fd_outb(unsigned char value, int port)
...@@ -180,8 +197,7 @@ static void sun_82077_fd_outb(unsigned char value, int port) ...@@ -180,8 +197,7 @@ static void sun_82077_fd_outb(unsigned char value, int port)
printk("floppy: Asked to write to unknown port %d\n", port); printk("floppy: Asked to write to unknown port %d\n", port);
panic("floppy: Port bolixed."); panic("floppy: Port bolixed.");
case 2: /* FD_DOR */ case 2: /* FD_DOR */
/* Happily, the 82077 has a real DOR register. */ sun_set_dor(value, 1);
sun_fdc->dor_82077 = value;
break; break;
case 5: /* FD_DATA */ case 5: /* FD_DATA */
sun_fdc->data_82077 = value; sun_fdc->data_82077 = value;
...@@ -192,6 +208,9 @@ static void sun_82077_fd_outb(unsigned char value, int port) ...@@ -192,6 +208,9 @@ static void sun_82077_fd_outb(unsigned char value, int port)
case 4: /* FD_STATUS */ case 4: /* FD_STATUS */
sun_fdc->status_82077 = value; sun_fdc->status_82077 = value;
break; break;
case 3: /* FD_TDR */
sun_fdc->tapectl_82077 = value;
break;
}; };
return; return;
} }
...@@ -332,16 +351,17 @@ static int sun_floppy_init(void) ...@@ -332,16 +351,17 @@ static int sun_floppy_init(void)
goto no_sun_fdc; goto no_sun_fdc;
} }
if(sparc_cpu_model == sun4c) {
sun_fdops.fd_inb = sun_82072_fd_inb;
sun_fdops.fd_outb = sun_82072_fd_outb;
fdc_status = &sun_fdc->status_82072;
/* printk("AUXIO @0x%lx\n", auxio_register); */ /* P3 */
} else {
sun_fdops.fd_inb = sun_82077_fd_inb; sun_fdops.fd_inb = sun_82077_fd_inb;
sun_fdops.fd_outb = sun_82077_fd_outb; sun_fdops.fd_outb = sun_82077_fd_outb;
fdc_status = &sun_fdc->status_82077; fdc_status = &sun_fdc->status_82077;
/* printk("DOR @0x%p\n", &sun_fdc->dor_82077); */ /* P3 */
if (sun_fdc->dor_82077 == 0x80) {
sun_fdc->dor_82077 = 0x02;
if (sun_fdc->dor_82077 == 0x80) {
sun_fdops.fd_inb = sun_82072_fd_inb;
sun_fdops.fd_outb = sun_82072_fd_outb;
fdc_status = &sun_fdc->status_82072;
}
} }
/* Success... */ /* Success... */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment