372 lines
9.0 KiB
C++
372 lines
9.0 KiB
C++
//#define USE_LOGGING
|
|
//======================================================================
|
|
// This file is part of VCC (Virtual Color Computer).
|
|
// Vcc is Copyright 2015 by Joseph Forgione
|
|
//
|
|
// VCC (Virtual Color Computer) is free software, you can redistribute
|
|
// and/or modify it under the terms of the GNU General Public License
|
|
// as published by the Free Software Foundation, either version 3 of
|
|
// the License, or (at your option) any later version.
|
|
//
|
|
// VCC (Virtual Color Computer) is distributed in the hope that it will
|
|
// be useful, but WITHOUT ANY WARRANTY; without even the implied
|
|
// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
// See the GNU General Public License for more details.
|
|
//
|
|
// You should have received a copy of the GNU General Public License
|
|
// along with VCC (Virtual Color Computer). If not, see
|
|
// <http://www.gnu.org/licenses/>.
|
|
//
|
|
//======================================================================
|
|
|
|
#include <string>
|
|
#include "IdeBus.h"
|
|
#include <stdio.h>
|
|
#include <Windows.h>
|
|
#include <vcc/util/logger.h>
|
|
|
|
static unsigned int Lba=0,LastLba;
|
|
static unsigned char XferBuffer[512]="";
|
|
|
|
static unsigned int BufferIndex=0;
|
|
static unsigned int BufferLenth=0;
|
|
static unsigned char CurrentCommand=0;
|
|
void ExecuteCommand();
|
|
void ByteSwap (char *);
|
|
static IDEINTERFACE Registers;
|
|
static HANDLE hDiskFile[2] {};
|
|
static unsigned char DiskSelect=0,LbaEnabled=0;
|
|
unsigned long BytesMoved=0;
|
|
unsigned char BusyCounter=BUSYWAIT;
|
|
HANDLE OpenDisk(const char *,unsigned char);
|
|
static unsigned short IDBlock[2][256];
|
|
static unsigned char Mounted=0,ScanCount=0;
|
|
static char CurrStatus[32]="IDE:Idle ";
|
|
static char FileNames[2][MAX_PATH]={"",""};
|
|
|
|
void IdeInit()
|
|
{
|
|
Registers.Command=0;
|
|
Registers.Cylinderlsb=0;
|
|
Registers.Cylindermsb=0;
|
|
Registers.Data=0;
|
|
Registers.Error[MASTER]=0;
|
|
Registers.Error[SLAVE]=0;
|
|
Registers.Head=0;
|
|
Registers.SecCount=0;
|
|
Registers.SecNumber=0;
|
|
Registers.Status[MASTER]=0;
|
|
Registers.Status[SLAVE]=0;
|
|
Lba=0;
|
|
BufferIndex=0;
|
|
CurrentCommand=0;
|
|
BufferLenth=0;
|
|
memset(XferBuffer,0,512);
|
|
return;
|
|
}
|
|
|
|
void IdeRegWrite(unsigned char Reg,unsigned short Data)
|
|
{
|
|
unsigned char SData=(unsigned char)Data&0xFF;
|
|
|
|
switch (Reg)
|
|
{
|
|
case 0x0:
|
|
if (!CurrentCommand)
|
|
return;
|
|
Registers.Data=Data;
|
|
XferBuffer[BufferIndex]= Registers.Data & 0xFF;
|
|
XferBuffer[BufferIndex+1]=(Registers.Data>>8)&0xFF;
|
|
BufferIndex+=2;
|
|
if (BufferIndex>=BufferLenth)
|
|
{
|
|
if ((CurrentCommand==0x30) | (CurrentCommand==0x31))
|
|
{
|
|
SetFilePointer(hDiskFile[DiskSelect],Lba*512,nullptr,FILE_BEGIN);
|
|
WriteFile(hDiskFile[DiskSelect],XferBuffer,512,&BytesMoved,nullptr);
|
|
}
|
|
BufferIndex=0;
|
|
BufferLenth=0;
|
|
CurrentCommand=0;
|
|
Registers.Status[DiskSelect]=RDY;
|
|
Registers.Error[DiskSelect]=0;
|
|
}
|
|
break;
|
|
case 0x1:
|
|
// Registers.Error=SData; //Write Precomp on write not used
|
|
break;
|
|
case 0x2:
|
|
Registers.SecCount=SData;
|
|
break;
|
|
case 0x3:
|
|
Registers.SecNumber=SData;
|
|
break;
|
|
case 0x4:
|
|
Registers.Cylinderlsb=SData;
|
|
break;
|
|
case 0x5:
|
|
Registers.Cylindermsb=SData;
|
|
break;
|
|
case 0x6:
|
|
Registers.Head=SData;
|
|
break;
|
|
case 0x7:
|
|
Registers.Command=SData;
|
|
ExecuteCommand();
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
} //End port switch
|
|
Lba=((Registers.Head&15)<<24)+(Registers.Cylindermsb<<16)+(Registers.Cylinderlsb<<8)+Registers.SecNumber;
|
|
DiskSelect=(Registers.Head >>4)&1;
|
|
LbaEnabled=(Registers.Head >>6)&1;
|
|
//LBa = [ (Cylinder * No of Heads + Heads) * Sectors/Track ] + (Sector-1) //CHS translation
|
|
}
|
|
|
|
unsigned short IdeRegRead(unsigned char Reg)
|
|
{
|
|
unsigned short RetVal=0;
|
|
|
|
switch (Reg)
|
|
{
|
|
case 0x0:
|
|
if (!CurrentCommand)
|
|
return 0;
|
|
Registers.Data=XferBuffer[BufferIndex] + (XferBuffer[BufferIndex+1]<<8);
|
|
BufferIndex+=2;
|
|
if (BufferIndex>=BufferLenth)
|
|
{
|
|
BufferIndex=0;
|
|
BufferLenth=0;
|
|
CurrentCommand=0;
|
|
Registers.Status[DiskSelect]=RDY;
|
|
Registers.Error[DiskSelect]=0;
|
|
}
|
|
RetVal=Registers.Data;
|
|
break;
|
|
case 0x1:
|
|
RetVal=Registers.Error[DiskSelect];
|
|
break;
|
|
case 0x2:
|
|
RetVal=Registers.SecCount;
|
|
break;
|
|
case 0x3:
|
|
RetVal=Registers.SecNumber;
|
|
break;
|
|
case 0x4:
|
|
RetVal=Registers.Cylinderlsb;
|
|
break;
|
|
case 0x5:
|
|
RetVal=Registers.Cylindermsb;
|
|
break;
|
|
case 0x6:
|
|
RetVal=Registers.Head;
|
|
break;
|
|
case 0x7:
|
|
if (BusyCounter)
|
|
{
|
|
BusyCounter--;
|
|
return BUSY;
|
|
}
|
|
RetVal=Registers.Status[DiskSelect];
|
|
break;
|
|
|
|
default:
|
|
RetVal=0;
|
|
break;
|
|
} //End port switch
|
|
return RetVal;
|
|
}
|
|
|
|
void ExecuteCommand()
|
|
{
|
|
CurrentCommand=Registers.Command;
|
|
char Temp=0;
|
|
switch (Registers.Command)
|
|
{
|
|
|
|
case 0x90: //Diagnostics
|
|
for (Temp=0;Temp<=1;Temp++)
|
|
{
|
|
Registers.Error[Temp]=0;
|
|
Registers.Status[Temp]=0;
|
|
if (hDiskFile[Temp]!=INVALID_HANDLE_VALUE)
|
|
{
|
|
Registers.Error[Temp]=0x01;
|
|
Registers.Status[Temp]=0x50;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case 0xEC: //Indentify Drive
|
|
memcpy(XferBuffer,IDBlock[DiskSelect],512);
|
|
BufferLenth=512;
|
|
BufferIndex=0;
|
|
Registers.Status[DiskSelect]=DRQ|RDY;
|
|
BusyCounter=BUSYWAIT;
|
|
break;
|
|
|
|
case 0x20: //Read Sectors /w Retry
|
|
case 0x21: //Read Sectors /wo Retry
|
|
sprintf(CurrStatus,"IDE: Rd Sec %000000.6X",Lba);
|
|
BusyCounter=BUSYWAIT;
|
|
BufferLenth=512;
|
|
BufferIndex=0;
|
|
Registers.Status[DiskSelect]=DRQ|RDY;
|
|
SetFilePointer(hDiskFile[DiskSelect],Lba*512,nullptr,FILE_BEGIN);
|
|
memset(XferBuffer,0,512);
|
|
ReadFile(hDiskFile[DiskSelect],XferBuffer,512,&BytesMoved,nullptr);
|
|
LastLba=Lba;
|
|
|
|
break;
|
|
|
|
case 0x30: //Write Sectors /w Retry
|
|
case 0x31: //Write Sectors /wo Retry
|
|
sprintf(CurrStatus,"IDE: Wr Sec %000000.6X",Lba);
|
|
BusyCounter=BUSYWAIT;
|
|
BufferLenth=512;
|
|
BufferIndex=0;
|
|
Registers.Status[DiskSelect]=DRQ|RDY;
|
|
memset(XferBuffer,0,512);
|
|
break;
|
|
case 0x50: //Format Track
|
|
|
|
break;
|
|
case 0x10: //All Recalibrate
|
|
case 0x11:
|
|
case 0x12:
|
|
case 0x13:
|
|
case 0x14:
|
|
case 0x15:
|
|
case 0x16:
|
|
case 0x17:
|
|
case 0x18:
|
|
case 0x19:
|
|
case 0x1A:
|
|
case 0x1B:
|
|
case 0x1C:
|
|
case 0x1D:
|
|
case 0x1E:
|
|
case 0x1F:
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
void ByteSwap (char *String)
|
|
{
|
|
int Index=0,Index2=0;
|
|
int Lenth=strlen(String);
|
|
char *NewString=(char*)malloc(Lenth+1);
|
|
memset(NewString, 0, Lenth + 1);
|
|
|
|
for (Index=0;Index<(Lenth+1);Index++)
|
|
if (String[Index^1])
|
|
NewString[Index2++]=String[Index^1];
|
|
memcpy(String,NewString,Lenth);
|
|
free(NewString);
|
|
return;
|
|
}
|
|
|
|
HANDLE OpenDisk(const char *ImageFile,unsigned char DiskNum)
|
|
{
|
|
HANDLE hTemp=nullptr;
|
|
unsigned long FileSize=0;
|
|
unsigned long LbaSectors=0;
|
|
char Model[41]="VCC VIRTUAL IDE DISK";
|
|
char Firmware[9]="0.99BETA";
|
|
char SerialNumber[21]="SERIAL NUMBER HERE";
|
|
|
|
|
|
strncpy(SerialNumber,ImageFile,20);
|
|
|
|
hTemp=CreateFile( ImageFile,GENERIC_READ | GENERIC_WRITE,0,nullptr,OPEN_EXISTING,FILE_ATTRIBUTE_NORMAL,nullptr);
|
|
if (hTemp==INVALID_HANDLE_VALUE)
|
|
return hTemp;
|
|
|
|
Registers.Status[DiskNum]=RDY;
|
|
Registers.Error[DiskNum]=0;
|
|
FileSize=SetFilePointer(hTemp,0,nullptr,FILE_END);
|
|
LbaSectors=FileSize>>9;
|
|
//Build Disk ID return Buffer
|
|
ByteSwap(Model);
|
|
ByteSwap(Firmware);
|
|
ByteSwap(SerialNumber);
|
|
memcpy (&IDBlock[DiskNum][27],Model,strlen(Model));
|
|
memcpy (&IDBlock[DiskNum][23],Firmware,strlen(Firmware));
|
|
memcpy (&IDBlock[DiskNum][10],SerialNumber,strlen(SerialNumber));
|
|
IDBlock[DiskNum][01]=(unsigned short)(LbaSectors/0x1000); //Logical Cylinders
|
|
IDBlock[DiskNum][03]=0x0010; //Logical Heads
|
|
IDBlock[DiskNum][04]=0x2000; //Logical Bytes per Track
|
|
IDBlock[DiskNum][05]=512; //Logical Bytes per Sector
|
|
IDBlock[DiskNum][06]=0x0100; //Logical Sectors per Track
|
|
IDBlock[DiskNum][20]=1; //Controller Type
|
|
IDBlock[DiskNum][21]=1; //# of 512Byte Buffers
|
|
IDBlock[DiskNum][49]=0x0200; //Bit 9=1 LBA Mode supported
|
|
IDBlock[DiskNum][51]=0x0A00; //PIO Cycle Time Bits 15-8
|
|
IDBlock[DiskNum][54]=(unsigned short)(LbaSectors/0x1000); //Cylinders
|
|
IDBlock[DiskNum][55]=0x0010; //Number of Heads
|
|
IDBlock[DiskNum][56]=0x0100; //Sectors per Track
|
|
IDBlock[DiskNum][61]=(unsigned short)(LbaSectors>>16); //LBA Sectors
|
|
IDBlock[DiskNum][60]=(unsigned short)(LbaSectors & 0xFFFF);
|
|
return hTemp;
|
|
}
|
|
|
|
void DiskStatus(char* text_buffer, size_t buffer_size)
|
|
{
|
|
strcpy(text_buffer,CurrStatus);
|
|
ScanCount++;
|
|
if (Lba != LastLba)
|
|
{
|
|
ScanCount=0;
|
|
LastLba=Lba;
|
|
}
|
|
if (ScanCount > 63)
|
|
{
|
|
ScanCount=0;
|
|
if (Mounted==1)
|
|
strcpy(CurrStatus,"IDE:Idle");
|
|
else
|
|
strcpy(CurrStatus,"IDe:No Image!");
|
|
}
|
|
return;
|
|
}
|
|
unsigned char MountDisk(const char *FileName,unsigned char DiskNumber)
|
|
{
|
|
if (DiskNumber>1)
|
|
return FALSE;
|
|
hDiskFile[DiskNumber]=OpenDisk( FileName, DiskNumber);
|
|
if (hDiskFile[DiskNumber]==INVALID_HANDLE_VALUE)
|
|
return FALSE;
|
|
strcpy(FileNames[DiskNumber],FileName);
|
|
Mounted=1;
|
|
DLOG_C(">>>MountDisk %d %d<<<\n",DiskNumber,hDiskFile[DiskNumber]);
|
|
return TRUE;
|
|
}
|
|
|
|
unsigned char DropDisk(unsigned char DiskNumber)
|
|
{
|
|
DLOG_C(">>>DropDisk %d %d<<<\n",DiskNumber,hDiskFile[DiskNumber]);
|
|
CloseHandle(hDiskFile[DiskNumber]);
|
|
hDiskFile[DiskNumber]=INVALID_HANDLE_VALUE;
|
|
strcpy(FileNames[DiskNumber],"");
|
|
Mounted=0;
|
|
return TRUE;
|
|
}
|
|
|
|
void QueryDisk(unsigned char DiskNumber,char *Name)
|
|
{
|
|
strcpy(Name,FileNames[DiskNumber]);
|
|
return;
|
|
}
|
|
|
|
std::string QueryDisk(unsigned char DiskNumber)
|
|
{
|
|
return FileNames[DiskNumber];
|
|
}
|
|
|
|
|