aaru-dps/aaruremote
1
0
Fork 0
mirror of https://github.com/aaru-dps/aaruremote.git synced 2025-12-16 19:24:37 +00:00
Code Issues Packages Projects Releases Wiki Activity

Implement Get SDHCI Registers packet.

Browse Source
This commit is contained in:
Natalia Portillo
2019-10-18 00:25:45 +01:00
parent 0be95c5c70
commit 62e90e0519
5 changed files with 134 additions and 54 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
device.c
View File

@@ -42,14 +42,14 @@ int32_t GetSdhciRegisters(const char* devicePath,
char** cid,
char** ocr,
char** scr,
int* csd_len,
int* cid_len,
int* ocr_len,
int* scr_len)
uint32_t* csd_len,
uint32_t* cid_len,
uint32_t* ocr_len,
uint32_t* scr_len)
{
#if defined(__linux__) && !defined(__ANDROID__)
return linux_get_sdhci_registers(devicePath, csd, cid, ocr, scr, csd_len, cid_len, ocr_len, scr_len);
#else
return -1;
return 0;
#endif
}

12
dicmote.h
View File

@@ -336,6 +336,10 @@ typedef struct
char cid[16];
char ocr[4];
char scr[8];
uint32_t csd_len;
uint32_t cid_len;
uint32_t ocr_len;
uint32_t scr_len;
} DicPacketResGetSdhciRegisters;
typedef struct
@@ -410,9 +414,9 @@ int32_t GetSdhciRegisters(const char* devicePath,
char** cid,
char** ocr,
char** scr,
int* csd_len,
int* cid_len,
int* ocr_len,
int* scr_len);
uint32_t* csd_len,
uint32_t* cid_len,
uint32_t* ocr_len,
uint32_t* scr_len);
#endif

8
linux/device.c
View File

@@ -124,10 +124,10 @@ int32_t linux_get_sdhci_registers(const char* devicePath,
char** cid,
char** ocr,
char** scr,
int* csd_len,
int* cid_len,
int* ocr_len,
int* scr_len)
uint32_t* csd_len,
uint32_t* cid_len,
uint32_t* ocr_len,
uint32_t* scr_len)
{
char* tmpString;
char* sysfsPath_csd;

8
linux/linux.h
View File

@@ -40,8 +40,8 @@ int32_t linux_get_sdhci_registers(const char* devicePath,
char** cid,
char** ocr,
char** scr,
int* csd_len,
int* cid_len,
int* ocr_len,
int* scr_len);
uint32_t* csd_len,
uint32_t* cid_len,
uint32_t* ocr_len,
uint32_t* scr_len);
#endif // DICREMOTE_LINUX_H

80
main.c
View File

@@ -60,6 +60,11 @@ int main()
uint32_t sense_len;
char* out_buf;
DicPacketResScsi* pkt_res_scsi;
DicPacketResGetSdhciRegisters* sdhciRegsResponsePacket;
char* csd;
char* cid;
char* ocr;
char* scr;
printf("DiscImageChef Remote Server %s\n", DICMOTE_VERSION);
printf("Copyright (C) 2019 Natalia Portillo\n");
@@ -390,6 +395,7 @@ int main()
write(cli_sock, deviceInfoResponsePacket, deviceInfoResponsePacket->hdr.len);
free(deviceInfoResponsePacket);
continue;
case DICMOTE_PACKET_TYPE_RESPONSE_GET_SDHCI_REGISTERS:
case DICMOTE_PACKET_TYPE_RESPONSE_LIST_DEVICES:
case DICMOTE_PACKET_TYPE_RESPONSE_SCSI:
case DICMOTE_PACKET_TYPE_RESPONSE_ATA_CHS:
@@ -397,7 +403,6 @@ int main()
case DICMOTE_PACKET_TYPE_RESPONSE_ATA_LBA48:
case DICMOTE_PACKET_TYPE_RESPONSE_SDHCI:
case DICMOTE_PACKET_TYPE_RESPONSE_GET_DEVTYPE:
case DICMOTE_PACKET_TYPE_RESPONSE_GET_SDHCI_REGISTERS:
case DICMOTE_PACKET_TYPE_RESPONSE_GET_USB_DATA:
case DICMOTE_PACKET_TYPE_RESPONSE_GET_FIREWIRE_DATA:
case DICMOTE_PACKET_TYPE_RESPONSE_GET_PCMCIA_DATA:
@@ -541,11 +546,82 @@ int main()
free(pkt_res_scsi);
if(sense_buf) free(sense_buf);
continue;
case DICMOTE_PACKET_TYPE_COMMAND_GET_SDHCI_REGISTERS:
// Packet only contains header so, dummy
in_buf = malloc(pkt_hdr->len);
if(!in_buf)
{
printf("Fatal error %d allocating memory for packet, closing connection...\n", errno);
free(pkt_hdr);
close(cli_sock);
continue;
}
recv(cli_sock, in_buf, pkt_hdr->len, 0);
free(in_buf);
sdhciRegsResponsePacket = malloc(sizeof(DicPacketResGetSdhciRegisters));
if(!sdhciRegsResponsePacket)
{
printf("Fatal error %d allocating memory for packet, closing connection...\n", errno);
free(pkt_hdr);
close(cli_sock);
continue;
}
memset(sdhciRegsResponsePacket, 0, sizeof(DicPacketResGetSdhciRegisters));
sdhciRegsResponsePacket->hdr.id = DICMOTE_PACKET_ID;
sdhciRegsResponsePacket->hdr.version = DICMOTE_PACKET_VERSION;
sdhciRegsResponsePacket->hdr.packet_type = DICMOTE_PACKET_TYPE_RESPONSE_GET_SDHCI_REGISTERS;
sdhciRegsResponsePacket->hdr.len = sizeof(DicPacketResGetSdhciRegisters);
sdhciRegsResponsePacket->isSdhci = GetSdhciRegisters(device_path,
&csd,
&cid,
&ocr,
&scr,
&sdhciRegsResponsePacket->csd_len,
&sdhciRegsResponsePacket->cid_len,
&sdhciRegsResponsePacket->ocr_len,
&sdhciRegsResponsePacket->scr_len);
if(sdhciRegsResponsePacket->csd_len > 0 && csd != NULL)
{
if(sdhciRegsResponsePacket->csd_len > 16) sdhciRegsResponsePacket->csd_len = 16;
memcpy(sdhciRegsResponsePacket->csd, csd, sdhciRegsResponsePacket->csd_len);
}
if(sdhciRegsResponsePacket->cid_len > 0 && cid != NULL)
{
if(sdhciRegsResponsePacket->cid_len > 16) sdhciRegsResponsePacket->cid_len = 16;
memcpy(sdhciRegsResponsePacket->cid, cid, sdhciRegsResponsePacket->cid_len);
}
if(sdhciRegsResponsePacket->ocr_len > 0 && ocr != NULL)
{
if(sdhciRegsResponsePacket->ocr_len > 4) sdhciRegsResponsePacket->ocr_len = 4;
memcpy(sdhciRegsResponsePacket->ocr, ocr, sdhciRegsResponsePacket->ocr_len);
}
if(sdhciRegsResponsePacket->scr_len > 0 && scr != NULL)
{
if(sdhciRegsResponsePacket->scr_len > 8) sdhciRegsResponsePacket->scr_len = 8;
memcpy(sdhciRegsResponsePacket->scr, scr, sdhciRegsResponsePacket->scr_len);
}
free(csd);
free(cid);
free(scr);
free(ocr);
write(cli_sock, sdhciRegsResponsePacket, sdhciRegsResponsePacket->hdr.len);
free(sdhciRegsResponsePacket);
continue;
case DICMOTE_PACKET_TYPE_COMMAND_ATA_CHS:
case DICMOTE_PACKET_TYPE_COMMAND_ATA_LBA28:
case DICMOTE_PACKET_TYPE_COMMAND_ATA_LBA48:
case DICMOTE_PACKET_TYPE_COMMAND_SDHCI:
case DICMOTE_PACKET_TYPE_COMMAND_GET_SDHCI_REGISTERS:
case DICMOTE_PACKET_TYPE_COMMAND_GET_USB_DATA:
case DICMOTE_PACKET_TYPE_COMMAND_GET_FIREWIRE_DATA:
case DICMOTE_PACKET_TYPE_COMMAND_GET_PCMCIA_DATA: