/***************************************************************************

       commodore vc1541 floppy disk drive

***************************************************************************/

/*
 vc1540
  higher serial bus timing than the vc1541, to fast for c64
 vc1541
  (also build in in sx64)
  used with commodore vc20, c64, c16, c128
  floppy disk drive 5 1/4 inch, single sided, double density,
   40 tracks (tone head to big to use 80 tracks?)
  gcr encoding

  computer M6502, 2x VIA6522, 2 KByte RAM, 16 KByte ROM
  1 Commodore serial bus (2 connectors)

 vc1541 ieee488 hardware modification
  additional ieee488 connection, modified rom

 vc1541 II
  ?

 dolphin drives
  vc1541 clone?
  additional 8 KByte RAM at 0x8000 (complete track buffer ?)
  24 KByte rom

 c1551
  used with commodore c16
  m6510t? processor (4 MHz???),
  (m6510t internal 4mhz clock?, 8 port pins?)
  VIA6522 ?, CIA6526 ?,
  2 KByte RAM, 16 KByte ROM
  connector commodore C16 expansion cartridge
  parallel protocoll

 1750
  single sided 1751
 1751
  (also build in in c128d series)
  used with c128 (vic20,c16,c64 possible?)
  double sided
  can read some other disk formats (mfm encoded?)
  modified commodore serial bus (with quick serial transmission)
  (m6510?, cia6526?)
0000-00FF      Zero page work area, job queue, variables
0100-01FF      GCR overflow area and stack (1571 mode BAM side 1)
0200-02FF      Command buffer, parser, tables, variables
0300-07FF      5 data buffers, 0-4 one of which is used for BAM
1800-1BFF      65C22A, serial, controller ports
1C00-1FFF      65C22A, controller ports
8000-FFE5      32K byte ROM, DOS and controller routines
FFE6-FFFF      JMP table, user command vectors

 1581
  3 1/2 inch, double sided, double density, 80 tracks
  used with c128 (vic20,c16,c64 possible?)
  only mfm encoding?
0000-00FF       Zero page work area, job queue, variables
0100-01FF       Stack, variables, vectors
0200-02FF       Command buffer, tables, variables
0300-09FF       Data buffers (0-6)
0A00-0AFF       BAM for tracks 0-39
0B00-0BFF       BAM for tracks 40-79
0C00-1FFF       Track cache buffer
4000-5FFF       8520A CIA
6000-7FFF       WD177X FDC
8000-FEFF       32K byte ROM, DOS and controller routines
FF00-FFFF       Jump table, vectors

 2031/4031
 ieee488 interface
 1541 with ieee488 bus instead of serial bus
  $1800 via6522 used for ieee488 interface?
  maybe like in pet series?
   port a data in/out?
   port b ce port, ddr 31

 2040/3040
 ieee488 interface
 2 drives

 2041
 ieee488 interface

 4040
 ieee488 interface
 2 drives

 sfd1001
 ieee488 interface
 5 1/4 inch high density
 2 heads

 */

#include <assert.h>
#include <stdio.h>

#include "driver.h"
#include "image.h"
#include "cpu/m6502/m6502.h"
#include "machine/6522via.h"

#define VERBOSE_DBG 1
#include "includes/cbm.h"
#include "includes/cbmdrive.h"
#include "includes/tpi6525.h"

#include "includes/vc1541.h"

/*
 * only for testing at the moment
 */

#define WRITEPROTECTED 0

/* 0 summarized, 1 computer, 2 vc1541 */
static struct
{
	int atn[3], data[3], clock[3];
}
serial;

/* G64 or D64 image
 implementation as writeback system
 */
typedef enum { TypeVC1541, TypeC1551, Type2031 } CBM_Drive_Emu_type;

typedef struct
{
	int cpunumber;
	CBM_Drive_Emu_type type;
	union {
		struct {
			int deviceid;
			int serial_atn, serial_clock, serial_data;
			int acka, data;
		} serial;
		struct {
			int deviceid;
		} ieee488;
		struct {
			UINT8 cpu_ddr, cpu_port;
			void *timer;
		} c1551;
	} drive;

	int via0irq, via1irq;

	int led, motor, frequency;

	double track;
	int clock;

	void *timer;

	struct {
		UINT8 data[(1+2+2+1+256/4+4)*5];
		int sync;
		int ready;
		int ffcount;
	} head;

	struct {
		int pos; /* position  in sector */
		int sector;
		UINT8 *data;
	} d64;
} CBM_Drive_Emu;

CBM_Drive_Emu vc1541_static= { 0 }, *vc1541 = &vc1541_static;

/* four different frequencies for the 4 different zones on the disk */
static double vc1541_times[4]= {
	13/16e6, 14/16e6, 15/16e6, 16/16e6
};

/*
 * gcr encoding 4 bits to 5 bits
 * 1 change, 0 none
 *
 * physical encoding of the data on a track
 * sector header
 *  sync (5x 0xff not gcr encoded)
 *  sync mark (0x08)
 *  checksum (chksum xor sector xor track xor id1 xor id2 gives 0)
 *  sector#
 *  track#
 *  id2 (disk id to prevent writing to disk after disk change)
 *  id1
 *  0x0f
 *  0x0f
 * cap normally 10 (min 5) byte?
 * sector data
 *  sync (5x 0xff not gcr encoded)
 *  sync mark (0x07)
 *  256 bytes
 *  checksum (256 bytes xored)
 * cap
 *
 * max 42 tracks, stepper resolution 84 tracks
 */
static int bin_2_gcr[] =
{
	0xa, 0xb, 0x12, 0x13, 0xe, 0xf, 0x16, 0x17,
	9, 0x19, 0x1a, 0x1b, 0xd, 0x1d, 0x1e, 0x15
};

#if 0
static int gcr_2_bin[] = {
	-1, -1, -1, -1,
	-1, -1, -1, -1,
	-1, 8, 0, 1,
	-1, 0xc, 4, 5,
	-1, -1, 2, 3,
	-1, 0xf, 6, 7,
	-1, 9, 0xa, 0xb,
	-1, 0xd, 0xe, -1
};
#endif

static void gcr_double_2_gcr(UINT8 a, UINT8 b, UINT8 c, UINT8 d, UINT8 *dest)
{
	UINT8 gcr[8];
	gcr[0]=bin_2_gcr[a>>4];
	gcr[1]=bin_2_gcr[a&0xf];
	gcr[2]=bin_2_gcr[b>>4];
	gcr[3]=bin_2_gcr[b&0xf];
	gcr[4]=bin_2_gcr[c>>4];
	gcr[5]=bin_2_gcr[c&0xf];
	gcr[6]=bin_2_gcr[d>>4];
	gcr[7]=bin_2_gcr[d&0xf];
	dest[0]=(gcr[0]<<3)|(gcr[1]>>2);
	dest[1]=(gcr[1]<<6)|(gcr[2]<<1)|(gcr[3]>>4);
	dest[2]=(gcr[3]<<4)|(gcr[4]>>1);
	dest[3]=(gcr[4]<<7)|(gcr[5]<<2)|(gcr[6]>>3);
	dest[4]=(gcr[6]<<5)|gcr[7];
}

static struct {
	int count;
	int data[4];
} gcr_helper;

static void vc1541_sector_start(void)
{
	gcr_helper.count=0;
}

static void vc1541_sector_data(UINT8 data, int *pos)
{
	gcr_helper.data[gcr_helper.count++]=data;
	if (gcr_helper.count==4) {
		gcr_double_2_gcr(gcr_helper.data[0], gcr_helper.data[1],
						 gcr_helper.data[2], gcr_helper.data[3],
						 vc1541->head.data+*pos);
		*pos=*pos+5;
		gcr_helper.count=0;
	}
}

static void vc1541_sector_end(int *pos)
{
	assert(gcr_helper.count==0);
}

static void vc1541_sector_to_gcr(int track, int sector)
{
	int i=0, j, offset, chksum=0;

	if (vc1541->d64.data==NULL) return;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541_sector_start();

	vc1541_sector_data(8, &i);
	chksum= sector^track
		^vc1541->d64.data[D64_TRACK_ID1]^vc1541->d64.data[D64_TRACK_ID2];
	vc1541_sector_data(chksum, &i);
	vc1541_sector_data(sector, &i);
	vc1541_sector_data(track, &i);
	vc1541_sector_data(vc1541->d64.data[D64_TRACK_ID1], &i);
	vc1541_sector_data(vc1541->d64.data[D64_TRACK_ID2], &i);
	vc1541_sector_data(0xf, &i);
	vc1541_sector_data(0xf, &i);
	vc1541_sector_end(&i);

	/* 5 - 10 gcr bytes cap */
	gcr_double_2_gcr(0, 0, 0, 0, vc1541->head.data+i);i+=5;
	gcr_double_2_gcr(0, 0, 0, 0, vc1541->head.data+i);i+=5;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541->head.data[i++]=0xff;
	vc1541_sector_data(0x7, &i);

	chksum=0;
	for (offset=d64_tracksector2offset(track,sector), j=0; j<256; j++) {
		chksum^=vc1541->d64.data[offset];
		vc1541_sector_data(vc1541->d64.data[offset++], &i);
	}
	vc1541_sector_data(chksum, &i);
	vc1541_sector_data(0, &i); /* padding up */
	vc1541_sector_data(0, &i);
	vc1541_sector_end(&i);
	gcr_double_2_gcr(0, 0, 0, 0, vc1541->head.data+i);i+=5;
	gcr_double_2_gcr(0, 0, 0, 0, vc1541->head.data+i);i+=5;
}

ADDRESS_MAP_START( vc1541_readmem , ADDRESS_SPACE_PROGRAM, 8)
	AM_RANGE(0x0000, 0x07ff) AM_READ( MRA8_RAM)
	AM_RANGE(0x1800, 0x180f) AM_READ( via_2_r)		   /* 0 and 1 used in vc20 */
	AM_RANGE(0x1810, 0x189f) AM_READ( MRA8_NOP) /* for debugger */
	AM_RANGE(0x1c00, 0x1c0f) AM_READ( via_3_r)
	AM_RANGE(0x1c10, 0x1c9f) AM_READ( MRA8_NOP) /* for debugger */
	AM_RANGE(0xc000, 0xffff) AM_READ( MRA8_ROM)
ADDRESS_MAP_END

ADDRESS_MAP_START( vc1541_writemem , ADDRESS_SPACE_PROGRAM, 8)
	AM_RANGE(0x0000, 0x07ff) AM_WRITE( MWA8_RAM)
	AM_RANGE(0x1800, 0x180f) AM_WRITE( via_2_w)
	AM_RANGE(0x1c00, 0x1c0f) AM_WRITE( via_3_w)
	AM_RANGE(0xc000, 0xffff) AM_WRITE( MWA8_ROM)
ADDRESS_MAP_END

ADDRESS_MAP_START( dolphin_readmem , ADDRESS_SPACE_PROGRAM, 8)
	AM_RANGE(0x0000, 0x07ff) AM_READ( MRA8_RAM)
	AM_RANGE(0x1800, 0x180f) AM_READ( via_2_r)		   /* 0 and 1 used in vc20 */
	AM_RANGE(0x1c00, 0x1c0f) AM_READ( via_3_r)
	AM_RANGE(0x8000, 0x9fff) AM_READ( MRA8_RAM)
	AM_RANGE(0xa000, 0xffff) AM_READ( MRA8_ROM)
ADDRESS_MAP_END

ADDRESS_MAP_START( dolphin_writemem , ADDRESS_SPACE_PROGRAM, 8)
	AM_RANGE(0x0000, 0x07ff) AM_WRITE( MWA8_RAM)
	AM_RANGE(0x1800, 0x180f) AM_WRITE( via_2_w)
	AM_RANGE(0x1c00, 0x1c0f) AM_WRITE( via_3_w)
	AM_RANGE(0x8000, 0x9fff) AM_WRITE( MWA8_RAM)
	AM_RANGE(0xa000, 0xffff) AM_WRITE( MWA8_ROM)
ADDRESS_MAP_END

#if 0
INPUT_PORTS_START (vc1541)
PORT_START
PORT_DIPNAME (0x60, 0x00, "Device #", CODE_NONE)
PORT_DIPSETTING (0x00, "8")
PORT_DIPSETTING (0x20, "9")
PORT_DIPSETTING (0x40, "10")
PORT_DIPSETTING (0x60, "11")
INPUT_PORTS_END
#endif

static void vc1541_timer(int param)
{
	if (vc1541->clock==0) {
		vc1541->clock=1;
		vc1541->head.ready=0;
		vc1541->head.sync=0;
		if (vc1541->type==TypeVC1541) {
			cpunum_set_input_line(vc1541->cpunumber, M6502_SET_OVERFLOW, 1);
			via_3_ca1_w(0,1);
		}
		return;
	}
	if (++(vc1541->d64.pos)>=sizeof(vc1541->head.data)) {
		if (++(vc1541->d64.sector)>=
			d64_sectors_per_track[(int)vc1541->track-1]) {
			vc1541->d64.sector=0;
		}
		vc1541_sector_to_gcr((int)vc1541->track,vc1541->d64.sector);
		vc1541->d64.pos=0;
	}
	vc1541->head.ready=1;
	if (vc1541->head.data[vc1541->d64.pos]==0xff) {
		vc1541->head.ffcount++;
		if (vc1541->head.ffcount==5) {
			vc1541->head.sync=1;
		}
	} else {
		vc1541->head.ffcount=0;
		vc1541->head.sync=0;
	}
	if (vc1541->type==TypeVC1541) {
		cpunum_set_input_line(vc1541->cpunumber, M6502_SET_OVERFLOW, 0);
		via_3_ca1_w(0,0);
	}
	vc1541->clock=0;
}

/*
 * via 6522 at 0x1800
 * port b
 * 0 inverted serial data in
 * 1 inverted serial data out
 * 2 inverted serial clock in
 * 3 inverted serial clock out
 * 4 inverted serial atn out
 * 5 input device id 1
 * 6 input device id 2
 * id 2+id 1/0+0 devicenumber 8/0+1 9/1+0 10/1+1 11
 * 7 inverted serial atn in
 * also ca1 (books says cb2)
 * irq to m6502 irq connected (or with second via irq)
 */
static void vc1541_via0_irq (int level)
{
	vc1541->via0irq = level;
	DBG_LOG(2, "vc1541 via0 irq",("level %d %d\n",vc1541->via0irq,vc1541->via1irq));
	cpunum_set_input_line (vc1541->cpunumber,
					  M6502_IRQ_LINE, vc1541->via1irq || vc1541->via0irq);
}

static  READ8_HANDLER( vc1541_via0_read_portb )
{
	static int old=-1;
	int value = 0x7a;

	if (!vc1541->drive.serial.serial_data || !serial.data[0])
		value |= 1;
	if (!vc1541->drive.serial.serial_clock || !serial.clock[0])
		value |= 4;
	if (!serial.atn[0]) value |= 0x80;

	switch (vc1541->drive.serial.deviceid)
	{
	case 8:
		value &= ~0x60;
		break;
	case 9:
		value &= ~0x40;
		break;
	case 10:
		value &= ~0x20;
		break;
	case 11:
		break;
	}
	if (value!=old) {

		DBG_LOG(2, "vc1541 serial read",("%s %s %s\n",
										 serial.atn[0]?"ATN":"atn",
										 serial.clock[0]?"CLOCK":"clock",
										 serial.data[0]?"DATA":"data"));

		DBG_LOG(2, "vc1541 serial read",("%s %s %s\n",
										 value&0x80?"ATN":"atn",
										 value&4?"CLOCK":"clock",
										 value&1?"DATA":"data"));
		old=value;
	}

	return value;
}

static WRITE8_HANDLER( vc1541_via0_write_portb )
{
	DBG_LOG(2, "vc1541 serial write",("%s %s %s\n",
									 data&0x10?"ATN":"atn",
									 data&8?"CLOCK":"clock",
									 data&2?"DATA":"data"));

	vc1541->drive.serial.data=data&2?0:1;
	vc1541->drive.serial.acka=(data&0x10)?1:0;

	if ((!(data & 2)) != vc1541->drive.serial.serial_data)
	{
		vc1541_serial_data_write (1, vc1541->drive.serial.serial_data = !(data & 2));
	}

	if ((!(data & 8)) != vc1541->drive.serial.serial_clock)
	{
		vc1541_serial_clock_write (1, vc1541->drive.serial.serial_clock = !(data & 8));
	}
	vc1541_serial_atn_write (1, vc1541->drive.serial.serial_atn = 1);
}

/*
 * via 6522 at 0x1c00
 * port a
    byte in gcr format from or to floppy

 * port b
 * 0 output steppermotor
 * 1 output steppermotor
     10: 00->01->10->11->00 move head to higher tracks
 * 2 output motor (rotation) (300 revolutions per minute)
 * 3 output led
 * 4 input disk not write protected
 * 5 timer adjustment
 * 6 timer adjustment
 * 4 different speed zones (track dependend)
    frequency select?
    3 slowest
    0 highest
 * 7 input sync signal when reading from disk (more then 9 1 bits)

 * ca1 byte ready input (also m6502 set overflow input)

 * ca2 set overflow enable for 6502
 * ca3 read/write
 *
 * irq to m6502 irq connected
 */
static void vc1541_via1_irq (int level)
{
	vc1541->via1irq = level;
	DBG_LOG(2, "vc1541 via1 irq",("level %d %d\n",vc1541->via0irq,vc1541->via1irq));
	cpunum_set_input_line (vc1541->cpunumber,
					  M6502_IRQ_LINE, vc1541->via1irq || vc1541->via0irq);
}

static  READ8_HANDLER( vc1541_via1_read_porta )
{
	int data=vc1541->head.data[vc1541->d64.pos];
	DBG_LOG(2, "vc1541 drive",("port a read %.2x\n", data));
	return data;
}

static WRITE8_HANDLER( vc1541_via1_write_porta )
{
	DBG_LOG(1, "vc1541 drive",("port a write %.2x\n", data));
}

static  READ8_HANDLER( vc1541_via1_read_portb )
{
	UINT8 value = 0xff;

#if 0
	if (WRITEPROTECTED)
		value &= ~0x10;
#endif
	if (vc1541->head.sync) {
		value&=~0x80;
	}

	return value;
}

static WRITE8_HANDLER( vc1541_via1_write_portb )
{
	static int old=0;
	if (data!=old) {
		DBG_LOG(1, "vc1541 drive",("%.2x\n", data));
		if ((old&3)!=(data&3)) {
			switch (old&3) {
			case 0:
				if ((data&3)==1) vc1541->track+=0.5;
				else if ((data&3)==3) vc1541->track-=0.5;
				break;
			case 1:
				if ((data&3)==2) vc1541->track+=0.5;
				else if ((data&3)==0) vc1541->track-=0.5;
				break;
			case 2:
				if ((data&3)==3) vc1541->track+=0.5;
				else if ((data&3)==1) vc1541->track-=0.5;
				break;
			case 3:
				if ((data&3)==0) vc1541->track+=0.5;
				else if ((data&3)==2) vc1541->track-=0.5;
				break;
			}
			if (vc1541->track<1) vc1541->track=1.0;
			if (vc1541->track>35) vc1541->track=35;
		}
		if ( (vc1541->motor!=(data&4))||(vc1541->frequency!=(data&0x60)) )
		{
			double tme;
			vc1541->motor = data & 4;
			vc1541->frequency = data & 0x60;
			tme=vc1541_times[vc1541->frequency>>5]*8*2;
			if (vc1541->motor)
			{
				if (timer_timeelapsed(vc1541->timer) > 1.0e29)
					timer_reset(vc1541->timer, TIME_NEVER);
				else
					timer_adjust(vc1541->timer, 0, 0, tme);
			}
			else
			{
				timer_reset(vc1541->timer, TIME_NEVER);
			}
		}
		old=data;
	}
	vc1541->led = data & 8;
}

static struct via6522_interface via2 =
{
	0,								   /*vc1541_via0_read_porta, */
	vc1541_via0_read_portb,
	0,								   /*via2_read_ca1, */
	0,								   /*via2_read_cb1, */
	0,								   /*via2_read_ca2, */
	0,								   /*via2_read_cb2, */
	0,								   /*via2_write_porta, */
	vc1541_via0_write_portb,
	0,                                 /*via2_write_ca1, */
	0,                                 /*via2_write_cb1, */
	0,								   /*via2_write_ca2, */
	0,								   /*via2_write_cb2, */
	vc1541_via0_irq
}, via3 =
{
	vc1541_via1_read_porta,
	vc1541_via1_read_portb,
	0,								   /*via3_read_ca1, */
	0,								   /*via3_read_cb1, */
	0,								   /*via3_read_ca2, */
	0,								   /*via3_read_cb2, */
	vc1541_via1_write_porta,
	vc1541_via1_write_portb,
	0,                                 /*via3_write_ca1, */
	0,                                 /*via3_write_cb1, */
	0,								   /*via3_write_ca2, */
	0,								   /*via3_write_cb2, */
	vc1541_via1_irq
};

DEVICE_LOAD(vc1541)
{
	int size;

	size = mame_fsize (file);
	if (!(vc1541->d64.data = (UINT8*) image_malloc(image, size)))
		return INIT_FAIL;

	if (size != mame_fread (file, vc1541->d64.data, size))
		return INIT_FAIL;

	logerror("floppy image %s loaded\n", image_filename(image));

	vc1541->timer = timer_alloc(vc1541_timer);
	return INIT_PASS;
}

DEVICE_UNLOAD(vc1541)
{
	/* writeback of image data */
	vc1541->d64.data = NULL;
	timer_reset(vc1541->timer, TIME_NEVER);	/* FIXME - timers should only be allocated once */
}

int vc1541_config (int id, int mode, VC1541_CONFIG *config)
{
	via_config (2, &via2);
	via_config (3, &via3);
	vc1541->type=TypeVC1541;
	vc1541->cpunumber = config->cpunr;
	vc1541->drive.serial.deviceid = config->devicenr;
	return 0;
}

void vc1541_reset (void)
{
	int i;

	if (vc1541->type==TypeVC1541) {
		for (i = 0; i < sizeof (serial.atn) / sizeof (serial.atn[0]); i++)
		{
			serial.atn[i] = serial.data[i] = serial.clock[i] = 1;
		}
	}
	vc1541->track=1.0;
	if ((vc1541->type==TypeVC1541)||(vc1541->type==Type2031)) {
		via_reset ();
	}
	if ((vc1541->type==TypeC1551)) {
		tpi6525_0_reset();
	}
}

/* delivers status for displaying */
extern void vc1541_drive_status (char *text, int size)
{
#if 1||VERBOSE_DBG
	if (vc1541->type==TypeVC1541) {
		snprintf (text, size, "%s %4.1f %s %.2x %s %s %s",
				  vc1541->led ? "LED" : "led",
				  vc1541->track,
				  vc1541->motor ? "MOTOR" : "motor",
				  vc1541->frequency,
				  serial.atn[0]?"ATN":"atn",
				  serial.clock[0]?"CLOCK":"clock",
				  serial.data[0]?"DATA":"data");
	} else if (vc1541->type==TypeC1551) {
		snprintf (text, size, "%s %4.1f %s %.2x",
				  vc1541->led ? "LED" : "led",
				  vc1541->track,
				  vc1541->motor ? "MOTOR" : "motor",
				  vc1541->frequency);
	}
#else
	text[0] = 0;
#endif
	return;
}

void vc1541_serial_reset_write (int which, int level)
{
}

int vc1541_serial_atn_read (int which)
{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
	return serial.atn[0];
}

void vc1541_serial_atn_write (int which, int level)
{
#if 0
	int value;
#endif
	if (serial.atn[1 + which] != level)
	{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
		serial.atn[1 + which] = level;
		if (serial.atn[0] != level)
		{
			serial.atn[0] = serial.atn[1] && serial.atn[2];
			if (serial.atn[0] == level)
			{
				DBG_LOG(1, "vc1541",("%d:%.4x atn %s\n",
									 cpu_getactivecpu (),
									 activecpu_get_pc(),
									 serial.atn[0]?"ATN":"atn"));
				via_set_input_ca1 (2, !level);
#if 0
				value=vc1541->drive.serial.data;
				if (vc1541->drive.serial.acka!=!level) value=0;
				if (value!=serial.data[2]) {
					serial.data[2]=value;
					if (serial.data[0]!=value) {
						serial.data[0]=serial.data[1] && serial.data[2];
					}
				}
#endif
			}
		}
	}
}

int vc1541_serial_data_read (int which)
{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
	return serial.data[0];
}

void vc1541_serial_data_write (int which, int level)
{
	if (serial.data[1 + which] != level)
	{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
		serial.data[1 + which] = level;
		if (serial.data[0] != level)
		{
			serial.data[0] = serial.data[1] && serial.data[2];
			if (serial.data[0] == level)
			{
				DBG_LOG(1, "vc1541",("%d:%.4x data %s\n",
									 cpu_getactivecpu (),
									 activecpu_get_pc(),
									 serial.data[0]?"DATA":"data"));
			}
		}
	}
}

int vc1541_serial_clock_read (int which)
{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
	return serial.clock[0];
}

void vc1541_serial_clock_write (int which, int level)
{
	if (serial.clock[1 + which] != level)
	{
#ifdef CPU_SYNC
		if (cpu_getactivecpu()==0) cpu_sync();
#endif
		serial.clock[1 + which] = level;
		if (serial.clock[0] != level)
		{
			serial.clock[0] = serial.clock[1] && serial.clock[2];
			if (serial.clock[0] == level)
			{
				DBG_LOG(1, "vc1541",("%d:%.4x clock %s\n",
									 cpu_getactivecpu (),
									 activecpu_get_pc(),
									 serial.clock[0]?"CLOCK":"clock"));
			}
		}
	}
}

int vc1541_serial_request_read (int which)
{
	return 1;
}

void vc1541_serial_request_write (int which, int level)
{
}

/*
  c1551 irq line
  only timing related??? (60 hz?), delivered from c16?
 */
static void c1551_timer(int param)
{
	cpunum_set_input_line(vc1541->cpunumber, M6502_IRQ_LINE, PULSE_LINE);
}

/*
  ddr 0x6f (p0 .. p5? in pinout)
  0,1: output stepper motor
  2 output motor (rotation) (300 revolutions per minute)
  3 output led ?
  4 input disk not write protected ?
  5,6: output frequency select
  7: input byte ready
 */
static WRITE8_HANDLER ( c1551_port_w )
{
	static int old=0;
	if (offset) {
		DBG_LOG(1, "c1551 port",("write %.2x\n",data));
		vc1541->drive.c1551.cpu_port=data;

		if (data!=old) {
			DBG_LOG(1, "vc1541 drive",("%.2x\n", data));
			if ((old&3)!=(data&3)) {
				switch (old&3) {
				case 0:
					if ((data&3)==1) vc1541->track+=0.5;
					else if ((data&3)==3) vc1541->track-=0.5;
					break;
				case 1:
					if ((data&3)==2) vc1541->track+=0.5;
					else if ((data&3)==0) vc1541->track-=0.5;
					break;
				case 2:
					if ((data&3)==3) vc1541->track+=0.5;
					else if ((data&3)==1) vc1541->track-=0.5;
					break;
				case 3:
					if ((data&3)==0) vc1541->track+=0.5;
					else if ((data&3)==2) vc1541->track-=0.5;
					break;
				}
				if (vc1541->track<1) vc1541->track=1.0;
				if (vc1541->track>35) vc1541->track=35;
			}
			if ( (vc1541->motor!=(data&4))||(vc1541->frequency!=(data&0x60)) ) {
				double tme;
				vc1541->motor = data & 4;
				vc1541->frequency = data & 0x60;
				tme=vc1541_times[vc1541->frequency>>5]*8*2;
				if (vc1541->motor)
				{
					if (timer_timeelapsed(vc1541->timer) > 1.0e29)
						timer_reset(vc1541->timer, TIME_NEVER);
					else
						timer_adjust(vc1541->timer, 0, 0, tme);
				}
				else
				{
					timer_reset(vc1541->timer, TIME_NEVER);
				}
			}
			old=data;
		}
		vc1541->led = data & 8;
	} else {
		vc1541->drive.c1551.cpu_ddr=data;
		DBG_LOG(1, "c1551 ddr",("write %.2x\n",data));
	}
}

static  READ8_HANDLER ( c1551_port_r )
{
	int data;

	if (offset) {
		data=0x7f;
#if 0
		if (WRITEPROTECTED)
			data &= ~0x10;
#endif
		if (vc1541->head.ready) {
			data|=0x80;
			vc1541->head.ready=0;
		}
		data&=~vc1541->drive.c1551.cpu_ddr;
		data|=vc1541->drive.c1551.cpu_ddr&vc1541->drive.c1551.cpu_port;
		DBG_LOG(3, "c1551 port",("read %.2x\n", data));
	} else {
		data=vc1541->drive.c1551.cpu_ddr;
		DBG_LOG(3, "c1551 ddr",("read %.2x\n", data));
	}
	return data;
}

/*
   tia6523
   port a
    c16 communication in/out
   port b
    drive data in/out
   port c ddr (0x1f)
    0 output status out
	1 output status out
	2 output
	3 output handshake out
	4 output
	5 input drive number 9
	6 input sync 0 active
	7 input handshake in
 */
static int c1551_port_c_r(void)
{
	int data=0xff;
	data&=~0x20;
	if (vc1541->head.sync) data&=~0x40;
	return data;
}

static int c1551_port_b_r (void)
{
	int data=vc1541->head.data[vc1541->d64.pos];
	DBG_LOG(2, "c1551 drive",("port a read %.2x\n", data));
	return data;
}

int c1551_config (int id, int mode, C1551_CONFIG *config)
{
	vc1541->cpunumber = config->cpunr;
	vc1541->type=TypeC1551;
	tpi6525[0].c.read=c1551_port_c_r;
	tpi6525[0].b.read=c1551_port_b_r;

	/* time should be small enough to allow quitting of the irq
	   line before the next interrupt is triggered */
	vc1541->drive.c1551.timer = timer_alloc(c1551_timer);
	timer_adjust(vc1541->drive.c1551.timer, 0, 0, 1.0/60);
	return 0;
}

ADDRESS_MAP_START( c1551_readmem , ADDRESS_SPACE_PROGRAM, 8)
    AM_RANGE(0x0000, 0x0001) AM_READ( c1551_port_r)
	AM_RANGE(0x0002, 0x07ff) AM_READ( MRA8_RAM)
    AM_RANGE(0x4000, 0x4007) AM_READ( tpi6525_0_port_r)
	AM_RANGE(0xc000, 0xffff) AM_READ( MRA8_ROM)
ADDRESS_MAP_END

ADDRESS_MAP_START( c1551_writemem , ADDRESS_SPACE_PROGRAM, 8)
    AM_RANGE(0x0000, 0x0001) AM_WRITE( c1551_port_w)
	AM_RANGE(0x0002, 0x07ff) AM_WRITE( MWA8_RAM)
    AM_RANGE(0x4000, 0x4007) AM_WRITE( tpi6525_0_port_w)
	AM_RANGE(0xc000, 0xffff) AM_WRITE( MWA8_ROM)
ADDRESS_MAP_END

static void c1551x_write_data (TPI6525 *This, int data)
{
	DBG_LOG(1, "c1551 cpu", ("%d write data %.2x\n",
						 cpu_getactivecpu (), data));
#ifdef CPU_SYNC
	cpu_sync();
#endif
	tpi6525_0_port_a_w(0,data);
}

static int c1551x_read_data (TPI6525 *This)
{
	int data=0xff;
#ifdef CPU_SYNC
	cpu_sync ();
#endif
	data=tpi6525_0_port_a_r(0);
	DBG_LOG(2, "c1551 cpu",("%d read data %.2x\n",
						 cpu_getactivecpu (), data));
	return data;
}

static void c1551x_write_handshake (TPI6525 *This, int data)
{
	DBG_LOG(1, "c1551 cpu",("%d write handshake %.2x\n",
						 cpu_getactivecpu (), data));
#ifdef CPU_SYNC
	cpu_sync();
#endif
	tpi6525_0_port_c_w(0,data&0x40?0xff:0x7f);
}

static int c1551x_read_handshake (TPI6525 *This)
{
	int data=0xff;
#ifdef CPU_SYNC
	cpu_sync();
#endif
	data=tpi6525_0_port_c_r(0)&8?0x80:0;
	DBG_LOG(2, "c1551 cpu",("%d read handshake %.2x\n",
						 cpu_getactivecpu (), data));
	return data;
}

static int c1551x_read_status (TPI6525 *This)
{
	int data=0xff;
#ifdef CPU_SYNC
	cpu_sync();
#endif
	data=tpi6525_0_port_c_r(0)&3;
	DBG_LOG(1, "c1551 cpu",("%d read status %.2x\n",
						 cpu_getactivecpu (), data));
	return data;
}

void c1551x_0_write_data (int data)
{
	c1551x_write_data(tpi6525, data);
}

int c1551x_0_read_data (void)
{
	return c1551x_read_data(tpi6525);
}

void c1551x_0_write_handshake (int data)
{
	c1551x_write_handshake(tpi6525, data);
}

int c1551x_0_read_handshake (void)
{
	return c1551x_read_handshake(tpi6525);
}

int c1551x_0_read_status (void)
{
	return c1551x_read_status(tpi6525);
}

MACHINE_DRIVER_START( cpu_vc1540 )
	MDRV_CPU_ADD_TAG("cpu_vc1540", M6502, 1000000)
	MDRV_CPU_PROGRAM_MAP(vc1541_readmem,vc1541_writemem)
MACHINE_DRIVER_END

MACHINE_DRIVER_START( cpu_vc1541 )
	MDRV_IMPORT_FROM( cpu_vc1540 )
MACHINE_DRIVER_END

MACHINE_DRIVER_START( cpu_c2031 )
	MDRV_IMPORT_FROM( cpu_vc1540 )
MACHINE_DRIVER_END

MACHINE_DRIVER_START( cpu_dolphin )
	MDRV_CPU_ADD_TAG("cpu_dolphin", M6502, 1000000)
	MDRV_CPU_PROGRAM_MAP(dolphin_readmem,dolphin_writemem)
MACHINE_DRIVER_END

MACHINE_DRIVER_START( cpu_c1551 )
	MDRV_CPU_ADD_TAG("cpu_c1551", M6510T, 2000000)
	MDRV_CPU_PROGRAM_MAP(c1551_readmem,c1551_writemem)
MACHINE_DRIVER_END

MACHINE_DRIVER_START( cpu_c1571 )
	MDRV_IMPORT_FROM( cpu_vc1541 )
MACHINE_DRIVER_END


void vc1541_device_getinfo(struct IODevice *dev)
{
	dev->type = IO_FLOPPY;
	dev->file_extensions = "d64\0";
	dev->count = 1;
	dev->reset_on_load = 1;
	dev->readable = 1;
	dev->writeable = 0;
	dev->creatable = 0;
	dev->load = device_load_vc1541;
	dev->unload = device_unload_vc1541;
	dev->genf1 = (genf *) vc1541_config;
}



void c2031_device_getinfo(struct IODevice *dev)
{
	vc1541_device_getinfo(dev);
}



void c1551_device_getinfo(struct IODevice *dev)
{
	vc1541_device_getinfo(dev);
	dev->genf1 = (genf *) c1551_config;
}



void c1571_device_getinfo(struct IODevice *dev)
{
	vc1541_device_getinfo(dev);
}
