int journalFlush(u32 device)
{// this write any thing that in are journal buffer :)
if(atadFlushCache(device))
return -EIO;
if(atadDmaTransfer(device, &journalBuf, APA_SECTOR_APAL, 1, ATAD_MODE_WRITE))
return -EIO;
if(atadFlushCache(device))
return -EIO;
return 0;
}
void apaSaveError(u32 device, void *buffer, u32 lba, u32 err_lba)
{
memset(buffer, 0, 512);
*(u32 *)buffer=err_lba;
atadDmaTransfer(device, buffer, lba, 1, ATAD_MODE_WRITE);
atadFlushCache(device);
}
int hddDevctl(iop_file_t *f, const char *devname, int cmd, void *arg,
unsigned int arglen, void *bufp, unsigned int buflen)
{
int rv=0;
WaitSema(fioSema);
switch(cmd)
{
// cmd set 1
case APA_DEVCTL_DEV9_SHUTDOWN:
atadUpdateAttrib(f->unit);
dev9Shutdown();
break;
case APA_DEVCTL_IDLE:
rv=atadIdle(f->unit, *(char *)arg);
break;
case APA_DEVCTL_MAX_SECTORS:
rv=hddDeviceBuf[f->unit].partitionMaxSize;
break;
case APA_DEVCTL_TOTAL_SECTORS:
rv=hddDeviceBuf[f->unit].totalLBA;
break;
case APA_DEVCTL_FLUSH_CACHE:
if(atadFlushCache(f->unit))
rv=-EIO;
break;
case APA_DEVCTL_SWAP_TMP:
rv=devctlSwapTemp(f->unit, (char *)arg);
break;
case APA_DEVCTL_SMART_STAT:
rv=atadGetStatus(f->unit);
break;
case APA_DEVCTL_STATUS:
rv=hddDeviceBuf[f->unit].status;
break;
case APA_DEVCTL_FORMAT:
rv=hddDeviceBuf[f->unit].format;
break;
// removed dos not work the way you like... use hddlib ;)
//case APA_DEVCTL_FREE_SECTORS:
//case APA_DEVCTL_FREE_SECTORS2:
// rv=apaGetFreeSectors(f->unit, bufp);
// break;
// cmd set 2 :)
case APA_DEVCTL_GETTIME:
rv=getPs2Time((ps2time *)bufp);
break;
case APA_DEVCTL_SET_OSDMBR:
rv=devctlSetOsdMBR(f->unit, (hddSetOsdMBR_t *)arg);
break;
case APA_DEVCTL_GET_SECTOR_ERROR:
rv=getPartErrorSector(f->unit, APA_SECTOR_SECTOR_ERROR, 0);
break;
case APA_DEVCTL_GET_ERROR_PART_NAME:
rv=getPartErrorName(f->unit, (char *)bufp);
break;
case APA_DEVCTL_ATA_READ:
rv=atadDmaTransfer(f->unit, (void *)bufp, ((hddAtaTransfer_t *)arg)->lba,
((hddAtaTransfer_t *)arg)->size, ATAD_MODE_READ);
break;
case APA_DEVCTL_ATA_WRITE:
rv=atadDmaTransfer(f->unit, ((hddAtaTransfer_t *)arg)->data,
((hddAtaTransfer_t *)arg)->lba, ((hddAtaTransfer_t *)arg)->size,
ATAD_MODE_WRITE);
break;
case APA_DEVCTL_SCE_IDENTIFY_DRIVE:
rv=atadSceIdentifyDrive(f->unit, (u16 *)bufp);
break;
case APA_DEVCTL_IS_48BIT:
rv=atadIs48bit(f->unit);
break;
case APA_DEVCTL_SET_TRANSFER_MODE:
rv=atadSetTransferMode(f->unit, ((hddAtaSetMode_t *)arg)->type, ((hddAtaSetMode_t *)arg)->mode);
break;
case APA_DEVCTL_ATA_IOP_WRITE:
rv=atadDmaTransfer(f->unit, ((hddAtaIOPTransfer_t *)arg)->data,
((hddAtaIOPTransfer_t *)arg)->lba, ((hddAtaIOPTransfer_t *)arg)->size,
ATAD_MODE_WRITE);
break;
default:
rv=-EINVAL;
break;
}
SignalSema(fioSema);
return rv;
}
int hddIoctl2(iop_file_t *f, int req, void *argp, unsigned int arglen,
void *bufp, unsigned int buflen)
{
u32 rv=0;
hdd_file_slot_t *fileSlot=f->privdata;
WaitSema(fioSema);
switch(req)
{
// cmd set 1
case APA_IOCTL2_ADD_SUB:
rv=ioctl2AddSub(fileSlot, (char *)argp);
break;
case APA_IOCTL2_DELETE_LAST_SUB:
rv=ioctl2DeleteLastSub(fileSlot);
break;
case APA_IOCTL2_NUMBER_OF_SUBS:
rv=fileSlot->nsub;
break;
case APA_IOCTL2_FLUSH_CACHE:
atadFlushCache(f->unit);
break;
// cmd set 2
case APA_IOCTL2_TRANSFER_DATA:
rv=ioctl2Transfer(f->unit, fileSlot, argp);
break;
case APA_IOCTL2_GETSIZE:
// rv=fileSlot->subs[*(u32 *)argp].length;
rv=((apa_subs *)(&fileSlot->start))[*(u32 *)argp].length; // !HACK!
break;
case APA_IOCTL2_GETHEADER:
if(atadDmaTransfer(f->unit, bufp, fileSlot->start, sizeof(apa_header)/512, ATAD_MODE_READ))
rv=-EIO;
rv=sizeof(apa_header);
break;
case APA_IOCTL2_SET_PART_ERROR:
setPartErrorSector(f->unit, fileSlot->start); rv=0;
break;
case APA_IOCTL2_GET_PART_ERROR:
if((rv=getPartErrorSector(f->unit, APA_SECTOR_PART_ERROR, bufp)) > 0) {
if(*(u32 *)bufp==fileSlot->start) {
rv=0; setPartErrorSector(f->unit, 0);// clear last error :)
}
}
break;
default:
rv=-EINVAL;
break;
}
SignalSema(fioSema);
return rv;
}
int hddFormat(iop_file_t *f, const char *dev, const char *blockdev, void *arg, size_t arglen)
{
int rv=0;
apa_cache *clink;
int i;
input_param params;
u32 emptyBlocks[32];
if(f->unit >= 2)
return -ENXIO;
// clear all errors on hdd
clink=cacheGetFree();
memset(clink->header, 0, sizeof(apa_header));
if(atadDmaTransfer(f->unit, clink->header, APA_SECTOR_SECTOR_ERROR, 1, ATAD_MODE_WRITE)){
cacheAdd(clink);
return -EIO;
}
if(atadDmaTransfer(f->unit, clink->header, APA_SECTOR_PART_ERROR, 1, ATAD_MODE_WRITE)){
cacheAdd(clink);
return -EIO;
}
// clear apa headers
for(i=1024*8;i<hddDeviceBuf[f->unit].totalLBA;i+=(1024*256))
{
atadDmaTransfer(f->unit, clink->header, i, sizeof(apa_header)/512,
ATAD_MODE_WRITE);
}
cacheAdd(clink);
if((rv=journalReset(f->unit))!=0)
return rv;
// set up mbr :)
if((clink=cacheGetHeader(f->unit, 0, 1, &rv))){
apa_header *header=clink->header;
memset(header, 0, sizeof(apa_header));
header->magic=APA_MAGIC;
header->length=(1024*256); // 128MB
header->type=APA_TYPE_MBR;
strcpy(header->id,"__mbr");
memcpy(header->mbr.magic, mbrMagic, 32);
header->mbr.version=APA_MBR_VERSION;
header->mbr.nsector=0;
getPs2Time(&header->created);
getPs2Time(&header->mbr.created);
header->checksum=apaCheckSum(header);
clink->flags|=CACHE_FLAG_DIRTY;
cacheFlushDirty(clink);
atadFlushCache(f->unit);
cacheAdd(clink);
hddDeviceBuf[f->unit].status=0;
hddDeviceBuf[f->unit].format=APA_MBR_VERSION;
}
memset(&emptyBlocks, 0, sizeof(emptyBlocks));
memset(¶ms, 0, sizeof(input_param));
params.size=(1024*256);
params.type=APA_TYPE_PFS;
// add __net, __system....
for(i=0;formatPartList[i];i++)
{
memset(params.id, 0, APA_IDMAX);
strcpy(params.id, formatPartList[i]);
if(!(clink=apaAddPartitionHere(f->unit, ¶ms, emptyBlocks, i ? clink->sector : 0, &rv)))
return rv;
cacheAdd(clink);
params.size<<=1;
if(hddDeviceBuf[f->unit].partitionMaxSize < params.size)
params.size=hddDeviceBuf[f->unit].partitionMaxSize;
}
return rv;
}
void hddPowerOffHandler(void* data)
{
printf("hdd flush cache\n");
atadFlushCache(0);
}
