128 lines
3.5 KiB
C
128 lines
3.5 KiB
C
#include <usbextreme.h>
|
|
#include <string.h>
|
|
|
|
usb_extreme_versions get_version(u8 version) {
|
|
switch (version) {
|
|
case 0: {
|
|
return USB_EXTREME_V0;
|
|
}
|
|
|
|
case 1: {
|
|
return USB_EXTREME_V1;
|
|
}
|
|
|
|
default: {
|
|
return USB_EXTREME_V1;
|
|
}
|
|
}
|
|
}
|
|
|
|
int oue_point_headers(usb_extreme_base **headers, void *raw_headers, size_t headerslen) {
|
|
int headers_nlen;
|
|
|
|
if (oue_num_headers(&headers_nlen, raw_headers, headerslen) <= 0) {
|
|
return -1;
|
|
}
|
|
|
|
*headers = raw_headers;
|
|
return headers_nlen;
|
|
}
|
|
|
|
int oue_num_headers(int *num_headers, const void *headers, size_t headerslen) {
|
|
int headers_nlen = (int) (headerslen / USBEXTREME_HEADER_SIZE);
|
|
|
|
if (!is_oue(headers, headerslen)) {
|
|
return -1;
|
|
}
|
|
|
|
*num_headers = headers_nlen;
|
|
return headers_nlen;
|
|
}
|
|
|
|
int oue_version(usb_extreme_versions *version, const void *headers, size_t headerslen) {
|
|
const usb_extreme_v1 *headers_oeu = headers;
|
|
int headers_nlen = (int) (headerslen / USBEXTREME_HEADER_SIZE);
|
|
usb_extreme_versions first_version = USB_EXTREME_V0;
|
|
int i;
|
|
|
|
if(!is_oue(headers, headerslen)) {
|
|
return -1;
|
|
}
|
|
|
|
for(i = 0; i < headers_nlen; i++) {
|
|
const usb_extreme_v1 header = headers_oeu[i];
|
|
|
|
if (i == 0) {
|
|
first_version = get_version(header.usb_extreme_version);
|
|
} else {
|
|
if (first_version != get_version(header.usb_extreme_version)) {
|
|
*version = USB_EXTREME_V0;
|
|
return -2;
|
|
}
|
|
}
|
|
}
|
|
|
|
*version = first_version;
|
|
return 1;
|
|
}
|
|
|
|
int oue_read_headers(usb_extreme_headers *headers, void *raw_headers, const size_t headerslen) {
|
|
usb_extreme_base *headers_ptr;
|
|
usb_extreme_versions version;
|
|
int num_headers = (int) (headerslen / USBEXTREME_HEADER_SIZE);
|
|
usb_extreme_headers headers_temp = {NULL, NULL, 0, 0, 0};
|
|
|
|
if(oue_point_headers(&headers_ptr, raw_headers, headerslen) <= 0) {
|
|
return -1;
|
|
}
|
|
|
|
if(oue_version(&version, raw_headers, headerslen) <= 0) {
|
|
return -1;
|
|
}
|
|
|
|
headers_temp.first_header = raw_headers;
|
|
headers_temp.headers = headers_ptr;
|
|
headers_temp.num_headers = num_headers;
|
|
headers_temp.headerslen = headerslen;
|
|
headers_temp.version = version;
|
|
*headers = headers_temp;
|
|
return 1;
|
|
}
|
|
|
|
int oue_read(usb_extreme_filestat *filestat, const usb_extreme_headers headers, const int filestats_nlen) {
|
|
int offset = filestats_nlen;
|
|
usb_extreme_v1 *headers_full = (usb_extreme_v1*) headers.headers;
|
|
usb_extreme_v1 header;
|
|
usb_extreme_filestat filestats_temp = {0, {'0'}, 0, 0, 0, 0};
|
|
u16 size = 0;
|
|
u8 video_mode = 0;
|
|
u8 usb_extreme_version;
|
|
int i;
|
|
|
|
for(i = 0; i < headers.num_headers; i++) {
|
|
if(offset == 0) {
|
|
return i;
|
|
}
|
|
|
|
header = headers_full[i];
|
|
strncpy(filestats_temp.name, header.name, USBEXTREME_NAME_LENGTH);
|
|
usb_extreme_version = header.usb_extreme_version;
|
|
|
|
if(usb_extreme_version >= 1) {
|
|
size = header.size;
|
|
video_mode = header.video_mode;
|
|
strncat(filestats_temp.name, header.name_ext, USBEXTREME_NAME_EXT_LENGTH);
|
|
}
|
|
|
|
filestats_temp.size = size;
|
|
filestats_temp.type = header.type;
|
|
filestats_temp.offset = i;
|
|
filestats_temp.video_mode = video_mode;
|
|
filestats_temp.usb_extreme_version = usb_extreme_version;
|
|
filestat[i] = filestats_temp;
|
|
offset -= 1;
|
|
}
|
|
|
|
return i;
|
|
}
|