| /* |
| * Copyright (C) 2008 The Android Open Source Project |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in |
| * the documentation and/or other materials provided with the |
| * distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
| * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| * SUCH DAMAGE. |
| */ |
| |
| #include "fastboot.h" |
| #include "make_ext4fs.h" |
| |
| #include <errno.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <stdarg.h> |
| #include <stdbool.h> |
| #include <string.h> |
| #include <sys/stat.h> |
| #include <sys/types.h> |
| #include <unistd.h> |
| |
| #ifdef USE_MINGW |
| #include <fcntl.h> |
| #else |
| #include <sys/mman.h> |
| #endif |
| |
| #define ARRAY_SIZE(x) (sizeof(x)/sizeof(x[0])) |
| |
| #define OP_DOWNLOAD 1 |
| #define OP_COMMAND 2 |
| #define OP_QUERY 3 |
| #define OP_NOTICE 4 |
| #define OP_FORMAT 5 |
| #define OP_DOWNLOAD_SPARSE 6 |
| #define OP_WAIT_FOR_DISCONNECT 7 |
| |
| typedef struct Action Action; |
| |
| #define CMD_SIZE 64 |
| |
| struct Action |
| { |
| unsigned op; |
| Action *next; |
| |
| char cmd[CMD_SIZE]; |
| const char *prod; |
| void *data; |
| unsigned size; |
| |
| const char *msg; |
| int (*func)(Action *a, int status, char *resp); |
| |
| double start; |
| }; |
| |
| static Action *action_list = 0; |
| static Action *action_last = 0; |
| |
| |
| struct image_data { |
| long long partition_size; |
| long long image_size; // real size of image file |
| void *buffer; |
| }; |
| |
| void generate_ext4_image(struct image_data *image); |
| void cleanup_image(struct image_data *image); |
| |
| int fb_getvar(struct usb_handle *usb, char *response, const char *fmt, ...) |
| { |
| char cmd[CMD_SIZE] = "getvar:"; |
| int getvar_len = strlen(cmd); |
| va_list args; |
| |
| response[FB_RESPONSE_SZ] = '\0'; |
| va_start(args, fmt); |
| vsnprintf(cmd + getvar_len, sizeof(cmd) - getvar_len, fmt, args); |
| va_end(args); |
| cmd[CMD_SIZE - 1] = '\0'; |
| return fb_command_response(usb, cmd, response); |
| } |
| |
| struct generator { |
| char *fs_type; |
| |
| /* generate image and return it as image->buffer. |
| * size of the buffer returned as image->image_size. |
| * |
| * image->partition_size specifies what is the size of the |
| * file partition we generate image for. |
| */ |
| void (*generate)(struct image_data *image); |
| |
| /* it cleans the buffer allocated during image creation. |
| * this function probably does free() or munmap(). |
| */ |
| void (*cleanup)(struct image_data *image); |
| } generators[] = { |
| { "ext4", generate_ext4_image, cleanup_image } |
| }; |
| |
| /* Return true if this partition is supported by the fastboot format command. |
| * It is also used to determine if we should first erase a partition before |
| * flashing it with an ext4 filesystem. See needs_erase() |
| * |
| * Not all devices report the filesystem type, so don't report any errors, |
| * just return false. |
| */ |
| int fb_format_supported(usb_handle *usb, const char *partition) |
| { |
| char response[FB_RESPONSE_SZ+1]; |
| struct generator *generator = NULL; |
| int status; |
| unsigned int i; |
| |
| status = fb_getvar(usb, response, "partition-type:%s", partition); |
| if (status) { |
| return 0; |
| } |
| |
| for (i = 0; i < ARRAY_SIZE(generators); i++) { |
| if (!strncmp(generators[i].fs_type, response, FB_RESPONSE_SZ)) { |
| generator = &generators[i]; |
| break; |
| } |
| } |
| |
| if (generator) { |
| return 1; |
| } |
| |
| return 0; |
| } |
| |
| static int cb_default(Action *a, int status, char *resp) |
| { |
| if (status) { |
| fprintf(stderr,"FAILED (%s)\n", resp); |
| } else { |
| double split = now(); |
| fprintf(stderr,"OKAY [%7.3fs]\n", (split - a->start)); |
| a->start = split; |
| } |
| return status; |
| } |
| |
| static Action *queue_action(unsigned op, const char *fmt, ...) |
| { |
| Action *a; |
| va_list ap; |
| size_t cmdsize; |
| |
| a = calloc(1, sizeof(Action)); |
| if (a == 0) die("out of memory"); |
| |
| va_start(ap, fmt); |
| cmdsize = vsnprintf(a->cmd, sizeof(a->cmd), fmt, ap); |
| va_end(ap); |
| |
| if (cmdsize >= sizeof(a->cmd)) { |
| free(a); |
| die("Command length (%d) exceeds maximum size (%d)", cmdsize, sizeof(a->cmd)); |
| } |
| |
| if (action_last) { |
| action_last->next = a; |
| } else { |
| action_list = a; |
| } |
| action_last = a; |
| a->op = op; |
| a->func = cb_default; |
| |
| a->start = -1; |
| |
| return a; |
| } |
| |
| void fb_queue_erase(const char *ptn) |
| { |
| Action *a; |
| a = queue_action(OP_COMMAND, "erase:%s", ptn); |
| a->msg = mkmsg("erasing '%s'", ptn); |
| } |
| |
| /* Loads file content into buffer. Returns NULL on error. */ |
| static void *load_buffer(int fd, off_t size) |
| { |
| void *buffer; |
| |
| #ifdef USE_MINGW |
| ssize_t count = 0; |
| |
| // mmap is more efficient but mingw does not support it. |
| // In this case we read whole image into memory buffer. |
| buffer = malloc(size); |
| if (!buffer) { |
| perror("malloc"); |
| return NULL; |
| } |
| |
| lseek(fd, 0, SEEK_SET); |
| while(count < size) { |
| ssize_t actually_read = read(fd, (char*)buffer+count, size-count); |
| |
| if (actually_read == 0) { |
| break; |
| } |
| if (actually_read < 0) { |
| if (errno == EINTR) { |
| continue; |
| } |
| perror("read"); |
| free(buffer); |
| return NULL; |
| } |
| |
| count += actually_read; |
| } |
| #else |
| buffer = mmap(NULL, size, PROT_READ, MAP_PRIVATE, fd, 0); |
| if (buffer == MAP_FAILED) { |
| perror("mmap"); |
| return NULL; |
| } |
| #endif |
| |
| return buffer; |
| } |
| |
| void cleanup_image(struct image_data *image) |
| { |
| #ifdef USE_MINGW |
| free(image->buffer); |
| #else |
| munmap(image->buffer, image->image_size); |
| #endif |
| } |
| |
| void generate_ext4_image(struct image_data *image) |
| { |
| int fd; |
| struct stat st; |
| |
| fd = fileno(tmpfile()); |
| make_ext4fs_sparse_fd(fd, image->partition_size, NULL, NULL); |
| |
| fstat(fd, &st); |
| image->image_size = st.st_size; |
| image->buffer = load_buffer(fd, st.st_size); |
| |
| close(fd); |
| } |
| |
| int fb_format(Action *a, usb_handle *usb, int skip_if_not_supported) |
| { |
| const char *partition = a->cmd; |
| char response[FB_RESPONSE_SZ+1]; |
| int status = 0; |
| struct image_data image; |
| struct generator *generator = NULL; |
| int fd; |
| unsigned i; |
| char cmd[CMD_SIZE]; |
| |
| status = fb_getvar(usb, response, "partition-type:%s", partition); |
| if (status) { |
| if (skip_if_not_supported) { |
| fprintf(stderr, |
| "Erase successful, but not automatically formatting.\n"); |
| fprintf(stderr, |
| "Can't determine partition type.\n"); |
| return 0; |
| } |
| fprintf(stderr,"FAILED (%s)\n", fb_get_error()); |
| return status; |
| } |
| |
| for (i = 0; i < ARRAY_SIZE(generators); i++) { |
| if (!strncmp(generators[i].fs_type, response, FB_RESPONSE_SZ)) { |
| generator = &generators[i]; |
| break; |
| } |
| } |
| if (!generator) { |
| if (skip_if_not_supported) { |
| fprintf(stderr, |
| "Erase successful, but not automatically formatting.\n"); |
| fprintf(stderr, |
| "File system type %s not supported.\n", response); |
| return 0; |
| } |
| fprintf(stderr,"Formatting is not supported for filesystem with type '%s'.\n", |
| response); |
| return -1; |
| } |
| |
| status = fb_getvar(usb, response, "partition-size:%s", partition); |
| if (status) { |
| if (skip_if_not_supported) { |
| fprintf(stderr, |
| "Erase successful, but not automatically formatting.\n"); |
| fprintf(stderr, "Unable to get partition size\n."); |
| return 0; |
| } |
| fprintf(stderr,"FAILED (%s)\n", fb_get_error()); |
| return status; |
| } |
| image.partition_size = strtoll(response, (char **)NULL, 16); |
| |
| generator->generate(&image); |
| if (!image.buffer) { |
| fprintf(stderr,"Cannot generate image.\n"); |
| return -1; |
| } |
| |
| // Following piece of code is similar to fb_queue_flash() but executes |
| // actions directly without queuing |
| fprintf(stderr, "sending '%s' (%lli KB)...\n", partition, image.image_size/1024); |
| status = fb_download_data(usb, image.buffer, image.image_size); |
| if (status) goto cleanup; |
| |
| fprintf(stderr, "writing '%s'...\n", partition); |
| snprintf(cmd, sizeof(cmd), "flash:%s", partition); |
| status = fb_command(usb, cmd); |
| if (status) goto cleanup; |
| |
| cleanup: |
| generator->cleanup(&image); |
| |
| return status; |
| } |
| |
| void fb_queue_format(const char *partition, int skip_if_not_supported) |
| { |
| Action *a; |
| |
| a = queue_action(OP_FORMAT, partition); |
| a->data = (void*)skip_if_not_supported; |
| a->msg = mkmsg("formatting '%s' partition", partition); |
| } |
| |
| void fb_queue_flash(const char *ptn, void *data, unsigned sz) |
| { |
| Action *a; |
| |
| a = queue_action(OP_DOWNLOAD, ""); |
| a->data = data; |
| a->size = sz; |
| a->msg = mkmsg("sending '%s' (%d KB)", ptn, sz / 1024); |
| |
| a = queue_action(OP_COMMAND, "flash:%s", ptn); |
| a->msg = mkmsg("writing '%s'", ptn); |
| } |
| |
| void fb_queue_flash_sparse(const char *ptn, struct sparse_file *s, unsigned sz) |
| { |
| Action *a; |
| |
| a = queue_action(OP_DOWNLOAD_SPARSE, ""); |
| a->data = s; |
| a->size = 0; |
| a->msg = mkmsg("sending sparse '%s' (%d KB)", ptn, sz / 1024); |
| |
| a = queue_action(OP_COMMAND, "flash:%s", ptn); |
| a->msg = mkmsg("writing '%s'", ptn); |
| } |
| |
| static int match(char *str, const char **value, unsigned count) |
| { |
| const char *val; |
| unsigned n; |
| int len; |
| |
| for (n = 0; n < count; n++) { |
| const char *val = value[n]; |
| int len = strlen(val); |
| int match; |
| |
| if ((len > 1) && (val[len-1] == '*')) { |
| len--; |
| match = !strncmp(val, str, len); |
| } else { |
| match = !strcmp(val, str); |
| } |
| |
| if (match) return 1; |
| } |
| |
| return 0; |
| } |
| |
| |
| |
| static int cb_check(Action *a, int status, char *resp, int invert) |
| { |
| const char **value = a->data; |
| unsigned count = a->size; |
| unsigned n; |
| int yes; |
| |
| if (status) { |
| fprintf(stderr,"FAILED (%s)\n", resp); |
| return status; |
| } |
| |
| if (a->prod) { |
| if (strcmp(a->prod, cur_product) != 0) { |
| double split = now(); |
| fprintf(stderr,"IGNORE, product is %s required only for %s [%7.3fs]\n", |
| cur_product, a->prod, (split - a->start)); |
| a->start = split; |
| return 0; |
| } |
| } |
| |
| yes = match(resp, value, count); |
| if (invert) yes = !yes; |
| |
| if (yes) { |
| double split = now(); |
| fprintf(stderr,"OKAY [%7.3fs]\n", (split - a->start)); |
| a->start = split; |
| return 0; |
| } |
| |
| fprintf(stderr,"FAILED\n\n"); |
| fprintf(stderr,"Device %s is '%s'.\n", a->cmd + 7, resp); |
| fprintf(stderr,"Update %s '%s'", |
| invert ? "rejects" : "requires", value[0]); |
| for (n = 1; n < count; n++) { |
| fprintf(stderr," or '%s'", value[n]); |
| } |
| fprintf(stderr,".\n\n"); |
| return -1; |
| } |
| |
| static int cb_require(Action *a, int status, char *resp) |
| { |
| return cb_check(a, status, resp, 0); |
| } |
| |
| static int cb_reject(Action *a, int status, char *resp) |
| { |
| return cb_check(a, status, resp, 1); |
| } |
| |
| void fb_queue_require(const char *prod, const char *var, |
| int invert, unsigned nvalues, const char **value) |
| { |
| Action *a; |
| a = queue_action(OP_QUERY, "getvar:%s", var); |
| a->prod = prod; |
| a->data = value; |
| a->size = nvalues; |
| a->msg = mkmsg("checking %s", var); |
| a->func = invert ? cb_reject : cb_require; |
| if (a->data == 0) die("out of memory"); |
| } |
| |
| static int cb_display(Action *a, int status, char *resp) |
| { |
| if (status) { |
| fprintf(stderr, "%s FAILED (%s)\n", a->cmd, resp); |
| return status; |
| } |
| fprintf(stderr, "%s: %s\n", (char*) a->data, resp); |
| return 0; |
| } |
| |
| void fb_queue_display(const char *var, const char *prettyname) |
| { |
| Action *a; |
| a = queue_action(OP_QUERY, "getvar:%s", var); |
| a->data = strdup(prettyname); |
| if (a->data == 0) die("out of memory"); |
| a->func = cb_display; |
| } |
| |
| static int cb_save(Action *a, int status, char *resp) |
| { |
| if (status) { |
| fprintf(stderr, "%s FAILED (%s)\n", a->cmd, resp); |
| return status; |
| } |
| strncpy(a->data, resp, a->size); |
| return 0; |
| } |
| |
| void fb_queue_query_save(const char *var, char *dest, unsigned dest_size) |
| { |
| Action *a; |
| a = queue_action(OP_QUERY, "getvar:%s", var); |
| a->data = (void *)dest; |
| a->size = dest_size; |
| a->func = cb_save; |
| } |
| |
| static int cb_do_nothing(Action *a, int status, char *resp) |
| { |
| fprintf(stderr,"\n"); |
| return 0; |
| } |
| |
| void fb_queue_reboot(void) |
| { |
| Action *a = queue_action(OP_COMMAND, "reboot"); |
| a->func = cb_do_nothing; |
| a->msg = "rebooting"; |
| } |
| |
| void fb_queue_command(const char *cmd, const char *msg) |
| { |
| Action *a = queue_action(OP_COMMAND, cmd); |
| a->msg = msg; |
| } |
| |
| void fb_queue_download(const char *name, void *data, unsigned size) |
| { |
| Action *a = queue_action(OP_DOWNLOAD, ""); |
| a->data = data; |
| a->size = size; |
| a->msg = mkmsg("downloading '%s'", name); |
| } |
| |
| void fb_queue_notice(const char *notice) |
| { |
| Action *a = queue_action(OP_NOTICE, ""); |
| a->data = (void*) notice; |
| } |
| |
| void fb_queue_wait_for_disconnect(void) |
| { |
| queue_action(OP_WAIT_FOR_DISCONNECT, ""); |
| } |
| |
| int fb_execute_queue(usb_handle *usb) |
| { |
| Action *a; |
| char resp[FB_RESPONSE_SZ+1]; |
| int status = 0; |
| |
| a = action_list; |
| if (!a) |
| return status; |
| resp[FB_RESPONSE_SZ] = 0; |
| |
| double start = -1; |
| for (a = action_list; a; a = a->next) { |
| a->start = now(); |
| if (start < 0) start = a->start; |
| if (a->msg) { |
| // fprintf(stderr,"%30s... ",a->msg); |
| fprintf(stderr,"%s...\n",a->msg); |
| } |
| if (a->op == OP_DOWNLOAD) { |
| status = fb_download_data(usb, a->data, a->size); |
| status = a->func(a, status, status ? fb_get_error() : ""); |
| if (status) break; |
| } else if (a->op == OP_COMMAND) { |
| status = fb_command(usb, a->cmd); |
| status = a->func(a, status, status ? fb_get_error() : ""); |
| if (status) break; |
| } else if (a->op == OP_QUERY) { |
| status = fb_command_response(usb, a->cmd, resp); |
| status = a->func(a, status, status ? fb_get_error() : resp); |
| if (status) break; |
| } else if (a->op == OP_NOTICE) { |
| fprintf(stderr,"%s\n",(char*)a->data); |
| } else if (a->op == OP_FORMAT) { |
| status = fb_format(a, usb, (int)a->data); |
| status = a->func(a, status, status ? fb_get_error() : ""); |
| if (status) break; |
| } else if (a->op == OP_DOWNLOAD_SPARSE) { |
| status = fb_download_data_sparse(usb, a->data); |
| status = a->func(a, status, status ? fb_get_error() : ""); |
| if (status) break; |
| } else if (a->op == OP_WAIT_FOR_DISCONNECT) { |
| usb_wait_for_disconnect(usb); |
| } else { |
| die("bogus action"); |
| } |
| } |
| |
| fprintf(stderr,"finished. total time: %.3fs\n", (now() - start)); |
| return status; |
| } |
| |
| int fb_queue_is_empty(void) |
| { |
| return (action_list == NULL); |
| } |