2 files changed, 126 insertions, 32 deletions

diff --git a/src/irecovery.c b/src/irecovery.c
index 7133606..1c4957e 100644
--- a/src/irecovery.c
+++ b/src/irecovery.c
@@ -23,7 +23,8 @@
 #include <readline/readline.h>
 #include <readline/history.h>
 
-#define FILE_HISTORY_PATH "~/.irecovery/history"
+#define FILE_HISTORY_PATH ".irecovery"
+#define debug(...) if(verbose) fprintf(stderr, __VA_ARGS__)
 
 enum {
         kResetDevice, kStartShell, kSendCommand, kSendFile
@@ -40,21 +41,29 @@ void print_shell_usage() {
 }
 
 void parse_command(irecv_device_t* device, unsigned char* command, unsigned int size) {
-        char* cmd = strtok(command, " ");
-        if(!strcmp(command, "/exit")) {
+        char* cmd = strtok(strdup(command), " ");
+        debug("Executing %s %s\n", cmd, command);
+        if(!strcmp(cmd, "/exit")) {
                 quit = 1;
         } else
         
-        if(!strcmp(command, "/help")) {
+        if(!strcmp(cmd, "/help")) {
                 print_shell_usage();
         } else
+
+        if(!strcmp(cmd, "/reconnect")) {
+                irecv_close(device);
+                irecv_open(device);
+        } else
         
-        if(!strcmp(command, "/upload")) {
+        if(!strcmp(cmd, "/upload")) {
                 char* filename = strtok(NULL, " ");
+                debug("Sending %s\n", filename);
                 if(filename != NULL) {
                         irecv_send_file(device, filename);
                 }
         }
+        free(cmd);
 }
 
 int recv_callback(irecv_device_t* device, unsigned char* data, int size) {
@@ -66,10 +75,41 @@ int recv_callback(irecv_device_t* device, unsigned char* data, int size) {
 }
 
 int send_callback(irecv_device_t* device, unsigned char* command, int size) {
+        irecv_error_t error = 0;
         if(command[0] == '/') {
                 parse_command(device, command, size);
                 return 0;
         }
+
+        if(strstr(command, "getenv") != NULL) {
+                unsigned char* value = NULL;
+                error = irecv_send_command(device, command);
+                if(error != IRECV_SUCCESS) {
+                        debug("%s\n", irecv_strerror(error));
+                        return error;
+                }
+
+                error = irecv_getenv(device, &value);
+                if(error != IRECV_SUCCESS) {
+                        debug("%s\n", irecv_strerror(error));
+                        return error;
+                }
+
+                printf("%s\n", value);
+                free(value);
+                return 0;
+        }
+
+        if(!strcmp(command, "reboot")) {
+                error = irecv_send_command(device, command);
+                if(error != IRECV_SUCCESS) {
+                        debug("%s\n", irecv_strerror(error));
+                        return error;
+                }
+                quit = 1;
+                return 0;
+        }
+
         return size;
 }
 
@@ -83,17 +123,21 @@ void append_command_to_history(char* cmd) {
 }
 
 void init_shell(irecv_device_t* device) {
+        irecv_error_t error = 0;
         load_command_history();
         irecv_set_sender(device, &send_callback);
         irecv_set_receiver(device, &recv_callback);
         while(!quit) {
-                if(irecv_update(device) != IRECV_SUCCESS) {
+                error = irecv_receive(device);
+                if(error != IRECV_SUCCESS) {
+                        debug("%s\n", irecv_strerror(error));
                         break;
                 }
                 
                 char* cmd = readline("> ");
                 if(cmd && *cmd) {
-                        if(irecv_send_command(device, cmd) != IRECV_SUCCESS) {
+                        error = irecv_send(device, cmd);
+                        if(error != IRECV_SUCCESS) {
                                 quit = 1;
                         }
                         
@@ -119,6 +163,7 @@ int main(int argc, char** argv) {
         int opt = 0;
         int action = 0;
         char* argument = NULL;
+        irecv_error_t error = 0;
         if(argc == 1) print_usage();
         while ((opt = getopt(argc, argv, "vhrsc:f:")) > 0) {
                 switch (opt) {
@@ -161,9 +206,17 @@ int main(int argc, char** argv) {
         }
         if(verbose) irecv_set_debug(device, verbose);
 
-        if(irecv_open(device) < 0) {
-                fprintf(stderr, "Unable to open device\n");
-                return -1;
+        int i = 0;
+        for(i = 0; i <= 5; i++) {
+                debug("Attempting to connect... ");
+                if(i == 5) {
+                        irecv_exit(device);
+                        return -1;
+                }
+
+                if(irecv_open(device) < 0) sleep(1);
+                else break;
+                debug("failed\n");
         }
 
         switch(action) {
@@ -172,11 +225,13 @@ int main(int argc, char** argv) {
                 break;
 
         case kSendFile:
-                irecv_send_file(device, argument);
+                error = irecv_send_file(device, argument);
+                debug("%s\n", irecv_strerror(error));
                 break;
 
         case kSendCommand:
-                irecv_send_command(device, argument);
+                error = irecv_send_command(device, argument);
+                debug("%s\n", irecv_strerror(error));
                 break;
 
         case kStartShell:
diff --git a/src/libirecovery.c b/src/libirecovery.c
index bcea61c..b8eb224 100644
--- a/src/libirecovery.c
+++ b/src/libirecovery.c
@@ -52,8 +52,8 @@ irecv_device_t* irecv_init() {
         }
         memset(device, '\0', sizeof(irecv_device_t));
 
-        irecv_set_receiver(device, &irecv_default_receiver);
-        irecv_set_sender(device, &irecv_default_sender);
+        //irecv_set_receiver(device, &irecv_default_receiver);
+        //irecv_set_sender(device, &irecv_default_sender);
         device->context = usb_context;
         return device;
 }
@@ -124,15 +124,13 @@ irecv_error_t irecv_set_interface(irecv_device_t* device, int interface, int alt
         if(device == NULL || device->handle == NULL) {
                 return IRECV_ERROR_NO_DEVICE; 
         }
-        
+
         if (libusb_claim_interface(device->handle, interface) < 0) {
                 return IRECV_ERROR_USB_INTERFACE;
         }
         
-        if(alt_interface > 0) {
-                if(libusb_set_interface_alt_setting(device->handle, interface, alt_interface) < 0) {
-                        return IRECV_ERROR_USB_INTERFACE;
-                }
+        if(libusb_set_interface_alt_setting(device->handle, interface, alt_interface) < 0) {
+                return IRECV_ERROR_USB_INTERFACE;
         }
         
         device->interface = interface;
@@ -192,7 +190,7 @@ irecv_error_t irecv_set_debug(irecv_device_t* device, int level) {
         return IRECV_SUCCESS;
 }
 
-irecv_error_t irecv_send_command(irecv_device_t* device, unsigned char* command) {
+irecv_error_t irecv_send(irecv_device_t* device, unsigned char* command) {
         if(device == NULL || device->handle == NULL) {
                 return IRECV_ERROR_NO_DEVICE;
         }
@@ -209,6 +207,23 @@ irecv_error_t irecv_send_command(irecv_device_t* device, unsigned char* command)
         }
 
         if(length > 0) {
+                irecv_send_command(device, command);
+        }
+
+        return IRECV_SUCCESS;
+}
+
+irecv_error_t irecv_send_command(irecv_device_t* device, unsigned char* command) {
+        if(device == NULL || device->handle == NULL) {
+                return IRECV_ERROR_NO_DEVICE;
+        }
+
+        unsigned int length = strlen(command);
+        if(length >= 0x100) {
+                length = 0xFF;
+        }
+
+        if(length > 0) {
                 libusb_control_transfer(device->handle, 0x40, 0, 0, 0, command, length+1, 100);
         }
         
@@ -243,7 +258,9 @@ irecv_error_t irecv_send_file(irecv_device_t* device, const char* filename) {
                 return IRECV_ERROR_UNKNOWN;
         }
 
-        return irecv_send_buffer(device, buffer, length);
+        irecv_error_t error = irecv_send_buffer(device, buffer, length);
+        free(buffer);
+        return error;
 }
 
 irecv_error_t irecv_get_status(irecv_device_t* device, unsigned int* status) {
@@ -254,11 +271,12 @@ irecv_error_t irecv_get_status(irecv_device_t* device, unsigned int* status) {
         
         unsigned char buffer[6];
         memset(buffer, '\0', 6);
-        if(libusb_control_transfer(device->handle, 0xA1, 3, 0, 0, buffer, 6, 500) != 6) {
+        if(libusb_control_transfer(device->handle, 0xA1, 3, 0, 0, buffer, 6, 1000) != 6) {
                 *status = 0;
                 return IRECV_ERROR_USB_STATUS;
         }
         
+        debug("status: %d\n", (unsigned int) buffer[4]);
         *status = (unsigned int) buffer[4];
         return IRECV_SUCCESS;
 }
@@ -268,46 +286,52 @@ irecv_error_t irecv_send_buffer(irecv_device_t* device, unsigned char* buffer, u
         if(device == NULL || device->handle == NULL) {
                 return IRECV_ERROR_NO_DEVICE; 
         }
-        
+
         int last = length % 0x800;
         int packets = length / 0x800;
         if (last != 0) {
                 packets++;
-        } else {
-                last = 0x800;
         }
 
         int i = 0;
         unsigned int status = 0;
         for (i = 0; i < packets; i++) {
                 int size = i + 1 < packets ? 0x800 : last;
-                int bytes = libusb_control_transfer(device->handle, 0x21, 1, i, 0, &buffer[i * 0x800], size, 500);
+                int bytes = libusb_control_transfer(device->handle, 0x21, 1, i, 0, &buffer[i * 0x800], size, 1000);
                 if (bytes != size) {
-                        free(buffer);
                         return IRECV_ERROR_USB_UPLOAD;
                 }
                 
+                debug("Sent %d bytes\n", bytes);
+
                 error = irecv_get_status(device, &status);
-                if (error != IRECV_SUCCESS || status != 5) {
-                        free(buffer);
+                if (error != IRECV_SUCCESS) {
                         return error;
                 }
+
+                if(status != 5) {
+                        return IRECV_ERROR_USB_STATUS;
+                }
+
         }
 
+        //char command[0x100];
+        //memset(command, '\0', 0x100);
+        //snprintf(command, 0x100, "setenv filesize %d", length);
         libusb_control_transfer(device->handle, 0x21, 1, i, 0, buffer, 0, 1000);
         for (i = 0; i < 3; i++) {
                 error = irecv_get_status(device, &status);
                 if(error != IRECV_SUCCESS) {
-                        free(buffer);
                         return error;
                 }
         }
 
-        free(buffer);
+        //irecv_send_command(device, command);
+
         return IRECV_SUCCESS;
 }
 
-irecv_error_t irecv_update(irecv_device_t* device) {
+irecv_error_t irecv_receive(irecv_device_t* device) {
         unsigned char buffer[BUFFER_SIZE];
         memset(buffer, '\0', BUFFER_SIZE);
         if(device == NULL || device->handle == NULL) {
@@ -358,6 +382,21 @@ irecv_error_t irecv_set_sender(irecv_device_t* device, irecv_send_callback callb
         return IRECV_SUCCESS;
 }
 
+irecv_error_t irecv_getenv(irecv_device_t* device, unsigned char** var) {
+        unsigned char* value = (unsigned char*) malloc(0x200);
+        if(value == NULL) {
+                return IRECV_ERROR_OUT_OF_MEMORY;
+        }
+
+        int ret =  libusb_control_transfer(device->handle, 0xC0, 0, 0, 0, value, 0x200, 500);
+        if(ret < 0) {
+                return IRECV_ERROR_UNKNOWN;
+        }
+
+        *var = value;
+        return IRECV_SUCCESS;
+}
+
 const char* irecv_strerror(irecv_error_t error) {
         switch(error) {
         case IRECV_SUCCESS: