/* * Copyright (c) 2016-2018, Linaro Ltd. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * * 2. 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. * * 3. Neither the name of the copyright holder nor the names of its contributors * may be used to endorse or promote products derived from this software without * specific prior written permission. * * 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 HOLDER 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 #include #include #include #include #include #include #include #include #include #include "cdba-server.h" #include "device.h" #include "fastboot.h" #include "list.h" #include "ppps.h" #define ARRAY_SIZE(x) ((sizeof(x)/sizeof((x)[0]))) #define device_has_control(_dev, _op) \ ((_dev)->control_ops && (_dev)->control_ops->_op) #define device_control(_dev, _op, ...) \ (_dev)->control_ops->_op((_dev) , ## __VA_ARGS__) #define device_has_console(_dev, _op) \ ((_dev)->console_ops && (_dev)->console_ops->_op) #define device_console(_dev, _op, ...) \ (_dev)->console_ops->_op((_dev) , ## __VA_ARGS__) static struct list_head devices = LIST_INIT(devices); void device_add(struct device *device) { list_add(&devices, &device->node); } static void device_lock(struct device *device) { char lock[PATH_MAX]; int fd; int n; n = snprintf(lock, sizeof(lock), "/tmp/cdba-%s.lock", device->board); if (n >= (int)sizeof(lock)) errx(1, "failed to build lockfile path"); fd = open(lock, O_RDONLY | O_CREAT, 0666); if (fd >= 0) close(fd); fd = open(lock, O_RDONLY | O_CLOEXEC); if (fd < 0) err(1, "failed to open lockfile %s", lock); n = flock(fd, LOCK_EX | LOCK_NB); if (!n) return; warnx("board is in use, waiting..."); n = flock(fd, LOCK_EX); if (n < 0) err(1, "failed to lock lockfile %s", lock); } static bool device_check_access(struct device *device, const char *username) { struct device_user *user; if (!device->users) return true; if (!username) return false; list_for_each_entry(user, device->users, node) { if (!strcmp(user->username, username)) return true; } return false; } struct device *device_open(const char *board, const char *username, struct fastboot_ops *fastboot_ops) { struct device *device; list_for_each_entry(device, &devices, node) { if (!strcmp(device->board, board)) goto found; } return NULL; found: if (!device_check_access(device, username)) return NULL; assert(device->console_ops); assert(device->console_ops->open); assert(device->console_ops->write); device_lock(device); if (device_has_control(device, open)) { device->cdb = device_control(device, open); if (!device->cdb) errx(1, "failed to open device controller"); } device->console = device_console(device, open); if (!device->console) errx(1, "failed to open device console"); if (device->usb_always_on) device_usb(device, true); device->fastboot = fastboot_open(device->serial, fastboot_ops, NULL); return device; } static void device_impl_power(struct device *device, bool on) { device_control(device, power, on); } static void device_key(struct device *device, int key, bool asserted) { if (device_has_control(device, key)) device_control(device, key, key, asserted); } enum { DEVICE_STATE_START, DEVICE_STATE_CONNECT, DEVICE_STATE_PRESS, DEVICE_STATE_RELEASE_PWR, DEVICE_STATE_RELEASE_FASTBOOT, DEVICE_STATE_RUNNING, }; static void device_tick(void *data) { struct device *device = data; switch (device->state) { case DEVICE_STATE_START: /* Make sure power key is not engaged */ if (device->fastboot_key_timeout) device_key(device, DEVICE_KEY_FASTBOOT, true); if (device->has_power_key) device_key(device, DEVICE_KEY_POWER, false); device->state = DEVICE_STATE_CONNECT; watch_timer_add(10, device_tick, device); break; case DEVICE_STATE_CONNECT: /* Connect power and USB */ device_impl_power(device, true); device_usb(device, true); if (device->has_power_key) { device->state = DEVICE_STATE_PRESS; watch_timer_add(250, device_tick, device); } else if (device->fastboot_key_timeout) { device->state = DEVICE_STATE_RELEASE_FASTBOOT; watch_timer_add(device->fastboot_key_timeout * 1000, device_tick, device); } else { device->state = DEVICE_STATE_RUNNING; } break; case DEVICE_STATE_PRESS: /* Press power key */ device_key(device, DEVICE_KEY_POWER, true); device->state = DEVICE_STATE_RELEASE_PWR; watch_timer_add(100, device_tick, device); break; case DEVICE_STATE_RELEASE_PWR: /* Release power key */ device_key(device, DEVICE_KEY_POWER, false); if (device->fastboot_key_timeout) { device->state = DEVICE_STATE_RELEASE_FASTBOOT; watch_timer_add(device->fastboot_key_timeout * 1000, device_tick, device); } else { device->state = DEVICE_STATE_RUNNING; } break; case DEVICE_STATE_RELEASE_FASTBOOT: device_key(device, DEVICE_KEY_FASTBOOT, false); device->state = DEVICE_STATE_RUNNING; break; } } static int device_power_on(struct device *device) { if (!device || !device_has_control(device, power)) return 0; device->state = DEVICE_STATE_START; device_tick(device); return 0; } static int device_power_off(struct device *device) { if (!device || !device_has_control(device, power)) return 0; device_control(device, power, false); return 0; } int device_power(struct device *device, bool on) { if (on) return device_power_on(device); else return device_power_off(device); } void device_print_status(struct device *device) { if (device_has_control(device, print_status)) device_control(device, print_status); } void device_usb(struct device *device, bool on) { if (device->ppps_path) ppps_power(device, on); else if (device_has_control(device, usb)) device_control(device, usb, on); } int device_write(struct device *device, const void *buf, size_t len) { if (!device) return 0; return device_console(device, write, buf, len); } void device_fastboot_boot(struct device *device) { fastboot_boot(device->fastboot); } void device_fastboot_flash_reboot(struct device *device) { fastboot_flash(device->fastboot, "boot"); fastboot_reboot(device->fastboot); } void device_boot(struct device *device, const void *data, size_t len) { warnx("booting the board..."); if (device->set_active) fastboot_set_active(device->fastboot, device->set_active); fastboot_download(device->fastboot, data, len); device->boot(device); } void device_send_break(struct device *device) { if (device_has_console(device, send_break)) device_console(device, send_break); } void device_list_devices(const char *username) { struct device *device; size_t len; char buf[80]; list_for_each_entry(device, &devices, node) { if (!device_check_access(device, username)) continue; if (device->name) len = snprintf(buf, sizeof(buf), "%-20s %s", device->board, device->name); else len = snprintf(buf, sizeof(buf), "%s", device->board); cdba_send_buf(MSG_LIST_DEVICES, len, buf); } cdba_send_buf(MSG_LIST_DEVICES, 0, NULL); } void device_info(const char *username, const void *data, size_t dlen) { char *description = NULL; struct device *device; size_t len = 0; list_for_each_entry(device, &devices, node) { if (strncmp(device->board, data, dlen)) continue; if (!device_check_access(device, username)) continue; if (device->description) { description = device->description; len = strlen(device->description); break; } } cdba_send_buf(MSG_BOARD_INFO, len, description); } void device_close(struct device *dev) { if (!dev->usb_always_on) device_usb(dev, false); device_power(dev, false); if (device_has_control(dev, close)) device_control(dev, close); }