/** * @file mmc_card_access.cpp * */ #include "global.h" #if EFI_SIMULATOR #include #include #include #include #include #endif #define DIR_RESPONSE_SIZE 512 #define DIR_RESPONSE_BUFFER_SIZE (DIR_RESPONSE_SIZE + 2) #define DOT '.' #if EFI_FILE_LOGGING || EFI_SIMULATOR || EFI_UNIT_TEST #include "mmc_card.h" #include "efilib.h" /** * for funny reasons file name has to be at least 4 symbols before the dot */ bool isLogFile(const char *fileName) { int dotIndex = indexOf(fileName, DOT); if (dotIndex == -1) { return false; } if (dotIndex < 4) { return false; } return 0 == strncmp(fileName + dotIndex, DOT_MLG, 4); } #endif #if EFI_FILE_LOGGING || EFI_SIMULATOR #include "mmc_card.h" extern LoggingWithStorage sharedLogger; #define TRANSFER_SIZE 2048 static uint8_t buffer[TRANSFER_SIZE + 2]; static void setFileEntry(uint8_t *buffer, int index, const char *fileName, int fileSize) { int offset = 32 * index; int dotIndex = indexOf(fileName, DOT); // assert dotIndex != -1 memcpy(buffer + offset, fileName, dotIndex); for (int i = dotIndex; i < 8 ; i++) { buffer[offset + i] = 0; } memcpy(buffer + offset + 8, &fileName[dotIndex + 1], 3); buffer[offset + 11] = 1; for (int i = 0; i < 4; i++) { buffer[offset + 18 + i] = fileName[dotIndex + i - 4]; } *(uint32_t *) (&buffer[offset + 28]) = fileSize; } void handleTsR(ts_channel_s *tsChannel, char *input) { #if EFI_SIMULATOR printf("TS_SD r %d\n", input[1]); #endif // EFI_SIMULATOR const uint16_t* data16 = reinterpret_cast(input); if (input[0] == 0 && input[1] == TS_SD_PROTOCOL_RTC) { scheduleMsg(&sharedLogger, "TS_SD: RTC read command"); memset(buffer, 0, 9); sr5SendResponse(tsChannel, TS_CRC, buffer, 9); } else if (input[0] == 0 && input[1] == TS_SD_PROTOCOL_FETCH_INFO) { uint16_t length = SWAP_UINT16(data16[2]); scheduleMsg(&sharedLogger, "TS_SD: fetch buffer command, length=%d", length); if (length == 16) { buffer[0] = 1 + 4; // Card present + Ready buffer[1] = 0; // Y - error code buffer[2] = 2; // higher byte of '512' sector size buffer[3] = 0; // lower byte buffer[4] = 0; buffer[5] = 0x20; // 0x20 00 00 of 512 is 1G virtual card buffer[6] = 0; buffer[7] = 0; buffer[8] = 0; buffer[9] = 1; // number of files sr5SendResponse(tsChannel, TS_CRC, buffer, 16); } else if (length == DIR_RESPONSE_BUFFER_SIZE) { // SD read directory command memset(buffer, 0, DIR_RESPONSE_BUFFER_SIZE); #if EFI_SIMULATOR DIR *dr = opendir("."); if (dr == NULL) { // opendir returns NULL if couldn't open directory printf("Could not open current directory" ); return; } int index = 0; struct dirent *de; // Pointer for directory entry while ((de = readdir(dr)) != NULL) { const char * fileName = de->d_name; printf("%s\n", fileName); if (index >= DIR_RESPONSE_SIZE / 32) { break; } if (isLogFile(fileName)) { struct stat statBuffer; int status; int fileSize = 0; status = stat(fileName, &statBuffer); if (status == 0) { fileSize = statBuffer.st_size; } setFileEntry(buffer, index, fileName, fileSize); index++; } } closedir(dr); #endif // EFI_SIMULATOR sr5SendResponse(tsChannel, TS_CRC, buffer, 0x202); } } else if (input[0] == 0 && input[1] == TS_SD_PROTOCOL_FETCH_DATA) { int blockNumber = data16[1]; scheduleMsg(&sharedLogger, "TS_SD: fetch data command blockNumber=%d", blockNumber); int offset = blockNumber * TRANSFER_SIZE; } else { scheduleMsg(&sharedLogger, "TS_SD: unexpected r"); } } void handleTsW(ts_channel_s *tsChannel, char *input) { const uint16_t* data16 = reinterpret_cast(input); #if EFI_SIMULATOR printf("TS_SD w %d\n", input[1]); #endif // EFI_SIMULATOR if (input[0] == 0 && input[1] == TS_SD_PROTOCOL_FETCH_INFO) { int code = data16[2]; scheduleMsg(&sharedLogger, "TS_SD: w, code=%d", code); if (input[5] == TS_SD_PROTOCOL_DO) { scheduleMsg(&sharedLogger, "TS_SD_PROTOCOL_DO"); sendOkResponse(tsChannel, TS_CRC); } else if (input[5] == TS_SD_PROTOCOL_READ_DIR) { scheduleMsg(&sharedLogger, "TS_SD_PROTOCOL_READ_DIR"); sendOkResponse(tsChannel, TS_CRC); } else if (input[5] == TS_SD_PROTOCOL_REMOVE_FILE) { #if EFI_SIMULATOR DIR *dr = opendir("."); if (dr == NULL) { // opendir returns NULL if couldn't open directory printf("Could not open current directory" ); return; } struct dirent *de; // Pointer for directory entry while ((de = readdir(dr)) != NULL) { const char * fileName = de->d_name; printf("%s\n", fileName); if (isLogFile(fileName)) { int dotIndex = indexOf(fileName, DOT); if (0 == strncmp(input + 6, &fileName[dotIndex - 4], 4)) { printf("Removing %s\n", fileName); remove(fileName); break; } } } closedir(dr); #endif // EFI_SIMULATOR sendOkResponse(tsChannel, TS_CRC); } else if (input[5] == TS_SD_PROTOCOL_FETCH_COMPRESSED) { #if EFI_SIMULATOR DIR *dr = opendir("."); if (dr == NULL) { // opendir returns NULL if couldn't open directory printf("Could not open current directory" ); return; } struct dirent *de; // Pointer for directory entry while ((de = readdir(dr)) != NULL) { const char * fileName = de->d_name; printf("%s\n", fileName); if (isLogFile(fileName)) { int dotIndex = indexOf(fileName, DOT); if (0 == strncmp(input + 6, &fileName[dotIndex - 4], 4)) { printf("Will be uploading %s\n", fileName); break; } } } closedir(dr); #endif // EFI_SIMULATOR } } else { scheduleMsg(&sharedLogger, "TS_SD: unexpected w"); } } #endif // EFI_FILE_LOGGING