diff options
Diffstat (limited to 'samsung-ipc/device/galaxys2')
| -rw-r--r-- | samsung-ipc/device/galaxys2/galaxys2_ipc.c | 402 | ||||
| -rw-r--r-- | samsung-ipc/device/galaxys2/galaxys2_ipc.h | 44 | ||||
| -rw-r--r-- | samsung-ipc/device/galaxys2/galaxys2_loader.c | 765 | ||||
| -rw-r--r-- | samsung-ipc/device/galaxys2/galaxys2_loader.h | 82 |
4 files changed, 420 insertions, 873 deletions
diff --git a/samsung-ipc/device/galaxys2/galaxys2_ipc.c b/samsung-ipc/device/galaxys2/galaxys2_ipc.c index d68cf0d..5c1c9c3 100644 --- a/samsung-ipc/device/galaxys2/galaxys2_ipc.c +++ b/samsung-ipc/device/galaxys2/galaxys2_ipc.c @@ -1,13 +1,7 @@ -/** +/* * This file is part of libsamsung-ipc. * - * Copyright (C) 2012 Alexander Tarasikov <alexander.tarasikov@gmail.com> - * Copyright (C) 2011 Paul Kocialkowski <contact@paulk.fr> - * based on crespo IPC code which is: - * - * Copyright (C) 2011 Paul Kocialkowski <contact@paulk.fr> - * Joerie de Gram <j.de.gram@gmail.com> - * Simon Busch <morphis@gravedo.de> + * Copyright (C) 2013 Paul Kocialkowski <contact@paulk.fr> * * libsamsung-ipc is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by @@ -24,44 +18,400 @@ */ #include <stdlib.h> +#include <unistd.h> +#include <string.h> +#include <fcntl.h> +#include <sys/mman.h> + +#include <samsung-ipc.h> +#include <ipc.h> + +#include "xmm6260.h" +#include "xmm6260_hsic.h" +#include "xmm6260_sec_modem.h" +#include "galaxys2_ipc.h" + +int galaxys2_ipc_bootstrap(struct ipc_client *client) +{ + void *modem_image_data = NULL; + int modem_image_fd = -1; + int modem_boot_fd = -1; + int modem_link_fd = -1; + + unsigned char *p; + int rc; + + if (client == NULL) + return -1; + + ipc_client_log(client, "Starting galaxys2 modem bootstrap"); + + modem_image_fd = open(GALAXYS2_MODEM_IMAGE_DEVICE, O_RDONLY); + if (modem_image_fd < 0) { + ipc_client_log(client, "Opening modem image device failed"); + goto error; + } + ipc_client_log(client, "Opened modem image device"); + + modem_image_data = mmap(0, GALAXYS2_MODEM_IMAGE_SIZE, PROT_READ, MAP_SHARED, modem_image_fd, 0); + if (modem_image_data == NULL || modem_image_data == (void *) 0xffffffff) { + ipc_client_log(client, "Mapping modem image data to memory failed"); + goto error; + } + ipc_client_log(client, "Mapped modem image data to memory"); + + modem_boot_fd = open(XMM6260_SEC_MODEM_BOOT0_DEVICE, O_RDWR | O_NOCTTY | O_NONBLOCK); + if (modem_boot_fd < 0) { + ipc_client_log(client, "Opening modem boot device failed"); + goto error; + } + ipc_client_log(client, "Opened modem boot device"); + + modem_link_fd = open(XMM6260_SEC_MODEM_LINK_PM_DEVICE, O_RDWR); + if (modem_link_fd < 0) { + ipc_client_log(client, "Opening modem link device failed"); + goto error; + } + ipc_client_log(client, "Opened modem link device"); + + rc = xmm6260_sec_modem_power(modem_boot_fd, 0); + rc |= xmm6260_sec_modem_link_control_enable(modem_link_fd, 0); + rc |= xmm6260_sec_modem_hci_power(0); + rc |= xmm6260_sec_modem_link_control_active(modem_link_fd, 0); + + if (rc < 0) { + ipc_client_log(client, "Turning the modem off failed"); + goto error; + } + ipc_client_log(client, "Turned the modem off"); + + rc = xmm6260_sec_modem_power(modem_boot_fd, 1); + rc |= xmm6260_sec_modem_link_control_enable(modem_link_fd, 1); + rc |= xmm6260_sec_modem_hci_power(1); + rc |= xmm6260_sec_modem_link_control_active(modem_link_fd, 1); + + if (rc < 0) { + ipc_client_log(client, "Turning the modem on failed"); + goto error; + } + ipc_client_log(client, "Turned the modem on"); + + rc = xmm6260_sec_modem_link_connected_wait(modem_link_fd); + if (rc < 0) { + ipc_client_log(client, "Waiting for link connected failed"); + goto error; + } + ipc_client_log(client, "Waited for link connected"); + + p = (unsigned char *) modem_image_data + GALAXYS2_PSI_OFFSET; + + rc = xmm6260_hsic_psi_send(client, modem_boot_fd, (void *) p, GALAXYS2_PSI_SIZE); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC PSI failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC PSI"); + + p = (unsigned char *) modem_image_data + GALAXYS2_EBL_OFFSET; + + rc = xmm6260_hsic_ebl_send(client, modem_boot_fd, (void *) p, GALAXYS2_EBL_SIZE); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC EBL failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC EBL"); + + rc = xmm6260_hsic_port_config_send(client, modem_boot_fd); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC port config failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC port config"); + + p = (unsigned char *) modem_image_data + GALAXYS2_SEC_START_OFFSET; + + rc = xmm6260_hsic_sec_start_send(client, modem_boot_fd, (void *) p, GALAXYS2_SEC_START_SIZE); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC SEC start failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC SEC start"); + + p = (unsigned char *) modem_image_data + GALAXYS2_FIRMWARE_OFFSET; + + rc = xmm6260_hsic_firmware_send(client, modem_boot_fd, (void *) p, GALAXYS2_FIRMWARE_SIZE); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC firmware failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC firmware"); + + rc = xmm6260_hsic_nv_data_send(client, modem_boot_fd); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC nv_data failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC nv_data"); + + rc = xmm6260_hsic_sec_end_send(client, modem_boot_fd); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC SEC end failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC SEC end"); + + rc = xmm6260_hsic_hw_reset_send(client, modem_boot_fd); + if (rc < 0) { + ipc_client_log(client, "Sending XMM6260 HSIC HW reset failed"); + goto error; + } + ipc_client_log(client, "Sent XMM6260 HSIC HW reset"); + + usleep(300000); + + rc = xmm6260_sec_modem_link_get_hostwake_wait(modem_link_fd); + if (rc < 0) { + ipc_client_log(client, "Waiting for host wake failed"); + } + + rc = xmm6260_sec_modem_link_control_enable(modem_link_fd, 0); + rc |= xmm6260_sec_modem_hci_power(0); + rc |= xmm6260_sec_modem_link_control_active(modem_link_fd, 0); + + if (rc < 0) { + ipc_client_log(client, "Turning the modem off failed"); + goto error; + } + + rc = xmm6260_sec_modem_link_get_hostwake_wait(modem_link_fd); + if (rc < 0) { + ipc_client_log(client, "Waiting for host wake failed"); + goto error; + } + ipc_client_log(client, "Waited for host wake"); + + rc = xmm6260_sec_modem_link_control_enable(modem_link_fd, 1); + rc |= xmm6260_sec_modem_hci_power(1); + rc |= xmm6260_sec_modem_link_control_active(modem_link_fd, 1); + + if (rc < 0) { + ipc_client_log(client, "Turning the modem on failed"); + goto error; + } + + rc = xmm6260_sec_modem_link_connected_wait(modem_link_fd); + if (rc < 0) { + ipc_client_log(client, "Waiting for link connected failed"); + goto error; + } + ipc_client_log(client, "Waited for link connected"); + + usleep(300000); + + rc = 0; + goto complete; + +error: + rc = -1; + +complete: + if (modem_image_data != NULL) + munmap(modem_image_data, GALAXYS2_MODEM_IMAGE_SIZE); + + if (modem_image_fd >= 0) + close(modem_image_fd); + + if (modem_boot_fd >= 0) + close(modem_boot_fd); + + if (modem_link_fd >= 0) + close(modem_link_fd); + + return rc; +} + + +int galaxys2_ipc_fmt_send(struct ipc_client *client, struct ipc_message_info *request) +{ + return xmm6260_sec_modem_ipc_fmt_send(client, request); +} + +int galaxys2_ipc_fmt_recv(struct ipc_client *client, struct ipc_message_info *response) +{ + return xmm6260_sec_modem_ipc_fmt_recv(client, response); +} + +int galaxys2_ipc_rfs_send(struct ipc_client *client, struct ipc_message_info *request) +{ + return xmm6260_sec_modem_ipc_rfs_send(client, request); +} + +int galaxys2_ipc_rfs_recv(struct ipc_client *client, struct ipc_message_info *response) +{ + return xmm6260_sec_modem_ipc_rfs_recv(client, response); +} + +int galaxys2_ipc_open(void *data, int type) +{ + struct galaxys2_ipc_transport_data *transport_data; + + if (data == NULL) + return -1; + + transport_data = (struct galaxys2_ipc_transport_data *) data; + + transport_data->fd = xmm6260_sec_modem_ipc_open(type); + if (transport_data->fd < 0) + return -1; + + return 0; +} + +int galaxys2_ipc_close(void *data) +{ + struct galaxys2_ipc_transport_data *transport_data; + + if (data == NULL) + return -1; + + transport_data = (struct galaxys2_ipc_transport_data *) data; + + xmm6260_sec_modem_ipc_close(transport_data->fd); + transport_data->fd = -1; + + return 0; +} + +int galaxys2_ipc_read(void *data, void *buffer, unsigned int length) +{ + struct galaxys2_ipc_transport_data *transport_data; + int rc; + + if (data == NULL) + return -1; + + transport_data = (struct galaxys2_ipc_transport_data *) data; + + rc = xmm6260_sec_modem_ipc_read(transport_data->fd, buffer, length); + return rc; +} + +int galaxys2_ipc_write(void *data, void *buffer, unsigned int length) +{ + struct galaxys2_ipc_transport_data *transport_data; + int rc; + + if (data == NULL) + return -1; + + transport_data = (struct galaxys2_ipc_transport_data *) data; + + rc = xmm6260_sec_modem_ipc_write(transport_data->fd, buffer, length); + return rc; +} + +int galaxys2_ipc_poll(void *data, struct timeval *timeout) +{ + struct galaxys2_ipc_transport_data *transport_data; + int rc; + + if (data == NULL) + return -1; + + transport_data = (struct galaxys2_ipc_transport_data *) data; + + rc = xmm6260_sec_modem_ipc_poll(transport_data->fd, timeout); + return rc; +} + +int galaxys2_ipc_power_on(void *data) +{ + return 0; +} + +int galaxys2_ipc_power_off(void *data) +{ + int fd; + int rc; + + fd = open(XMM6260_SEC_MODEM_BOOT0_DEVICE, O_RDWR | O_NOCTTY | O_NONBLOCK); + if (fd < 0) + return -1; + + rc = xmm6260_sec_modem_power(fd, 0); + + close(fd); + + if (rc < 0) + return -1; + + return 0; +} + +int galaxys2_ipc_data_create(void **transport_data, void **power_data, void **gprs_data) +{ + if (transport_data == NULL) + return -1; + + *transport_data = (void *) malloc(sizeof(struct galaxys2_ipc_transport_data)); + memset(*transport_data, 0, sizeof(struct galaxys2_ipc_transport_data)); + + return 0; +} + +int galaxys2_ipc_data_destroy(void *transport_data, void *power_data, void *gprs_data) +{ + if (transport_data == NULL) + return -1; + + free(transport_data); + + return 0; +} + +char *galaxys2_ipc_gprs_get_iface(int cid) +{ + return xmm6260_sec_modem_ipc_gprs_get_iface(cid); +} -#include "ipc.h" -#include "xmm6260_ipc.h" -#include "galaxys2_loader.h" +int galaxys2_ipc_gprs_get_capabilities(struct ipc_client_gprs_capabilities *capabilities) +{ + return xmm6260_sec_modem_ipc_gprs_get_capabilities(capabilities); +} struct ipc_ops galaxys2_ipc_fmt_ops = { .bootstrap = galaxys2_ipc_bootstrap, - .send = xmm6260_ipc_fmt_send, - .recv = xmm6260_ipc_fmt_recv, + .send = galaxys2_ipc_fmt_send, + .recv = galaxys2_ipc_fmt_recv, }; struct ipc_ops galaxys2_ipc_rfs_ops = { .bootstrap = NULL, - .send = xmm6260_ipc_rfs_send, - .recv = xmm6260_ipc_rfs_recv, + .send = galaxys2_ipc_rfs_send, + .recv = galaxys2_ipc_rfs_recv, }; struct ipc_handlers galaxys2_ipc_handlers = { - .open = xmm6260_ipc_open, - .close = xmm6260_ipc_close, - .read = xmm6260_ipc_read, - .write = xmm6260_ipc_write, - .poll = xmm6260_ipc_poll, + .read = galaxys2_ipc_read, + .write = galaxys2_ipc_write, + .open = galaxys2_ipc_open, + .close = galaxys2_ipc_close, + .poll = galaxys2_ipc_poll, .transport_data = NULL, - .power_on = xmm6260_ipc_power_on, - .power_off = xmm6260_ipc_power_off, + .power_on = galaxys2_ipc_power_on, + .power_off = galaxys2_ipc_power_off, .power_data = NULL, .gprs_activate = NULL, .gprs_deactivate = NULL, .gprs_data = NULL, - .data_create = xmm6260_ipc_data_create, - .data_destroy = xmm6260_ipc_data_destroy, + .data_create = galaxys2_ipc_data_create, + .data_destroy = galaxys2_ipc_data_destroy, }; struct ipc_gprs_specs galaxys2_ipc_gprs_specs = { - .gprs_get_iface = xmm6260_ipc_gprs_get_iface, - .gprs_get_capabilities = xmm6260_ipc_gprs_get_capabilities, + .gprs_get_iface = galaxys2_ipc_gprs_get_iface, + .gprs_get_capabilities = galaxys2_ipc_gprs_get_capabilities, }; // vim:ts=4:sw=4:expandtab diff --git a/samsung-ipc/device/galaxys2/galaxys2_ipc.h b/samsung-ipc/device/galaxys2/galaxys2_ipc.h new file mode 100644 index 0000000..a7e17c2 --- /dev/null +++ b/samsung-ipc/device/galaxys2/galaxys2_ipc.h @@ -0,0 +1,44 @@ +/* + * This file is part of libsamsung-ipc. + * + * Copyright (C) 2013 Paul Kocialkowski <contact@paulk.fr> + * + * libsamsung-ipc is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 2 of the License, or + * (at your option) any later version. + * + * libsamsung-ipc is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with libsamsung-ipc. If not, see <http://www.gnu.org/licenses/>. + * + */ + +#ifndef __GALAXYS2_IPC_H__ +#define __GALAXYS2_IPC_H__ + +#define GALAXYS2_MODEM_IMAGE_SIZE 0x1000000 +#define GALAXYS2_PSI_OFFSET 0 +#define GALAXYS2_PSI_SIZE 0xF000 +#define GALAXYS2_EBL_OFFSET 0xF000 +#define GALAXYS2_EBL_SIZE 0x19000 +#define GALAXYS2_SEC_START_OFFSET 0x9FF800 +#define GALAXYS2_SEC_START_SIZE 0x800 +#define GALAXYS2_FIRMWARE_OFFSET 0x28000 +#define GALAXYS2_FIRMWARE_SIZE 0x9D8000 +#define GALAXYS2_NV_DATA_OFFSET 0xA00000 +#define GALAXYS2_NV_DATA_SIZE 0x200000 + +#define GALAXYS2_MODEM_IMAGE_DEVICE "/dev/block/mmcblk0p8" + +struct galaxys2_ipc_transport_data { + int fd; +}; + +#endif + +// vim:ts=4:sw=4:expandtab diff --git a/samsung-ipc/device/galaxys2/galaxys2_loader.c b/samsung-ipc/device/galaxys2/galaxys2_loader.c deleted file mode 100644 index 03dca93..0000000 --- a/samsung-ipc/device/galaxys2/galaxys2_loader.c +++ /dev/null @@ -1,765 +0,0 @@ -/* - * Firmware loader for Samsung I9100 (galaxys2) - * Copyright (C) 2012 Alexander Tarasikov <alexander.tarasikov@gmail.com> - * Copyright (C) 2012 Paul Kocialkowski <contact@paulk.fr> - * - * based on the incomplete C++ implementation which is - * Copyright (C) 2012 Sergey Gridasov <grindars@gmail.com> - * - * This program is free software: you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation, either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program. If not, see <http://www.gnu.org/licenses/>. - */ - -#include <stdio.h> -#include <stdlib.h> -#include <stdbool.h> -#include <string.h> - -#include <getopt.h> -#include <unistd.h> -#include <fcntl.h> -#include <errno.h> -#include <sys/ioctl.h> - -//for timeval -#include <sys/time.h> - -//for mmap -#include <sys/mman.h> -#include <sys/stat.h> - -#include "ipc.h" - -#include "galaxys2_loader.h" -#include "xmm6260_loader.h" -#include "xmm6260_modemctl.h" -#include "modem_prj.h" - -#define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0])) - -/* - * Locations of the firmware components in the Samsung firmware - */ - -struct xmm6260_radio_part galaxys2_radio_parts[] = { - [PSI] = { - .offset = 0, - .length = 0xf000, - }, - [EBL] = { - .offset = 0xf000, - .length = 0x19000, - }, - [SECURE_IMAGE] = { - .offset = 0x9ff800, - .length = 0x800, - }, - [FIRMWARE] = { - .offset = 0x28000, - .length = 0x9d8000, - }, - [NVDATA] = { - .offset = 0xa00000, - .length = 2 << 20, - } -}; - -struct galaxys2_boot_cmd_desc galaxys2_boot_cmd_desc[] = { - [SetPortConf] = { - .code = 0x86, - .data_size = 0x800, - .need_ack = 1, - }, - [ReqSecStart] = { - .code = 0x204, - .data_size = 0x4000, - .need_ack = 1, - }, - [ReqSecEnd] = { - .code = 0x205, - .data_size = 0x4000, - .need_ack = 1, - }, - [ReqForceHwReset] = { - .code = 0x208, - .data_size = 0x4000, - .need_ack = 0, - }, - [ReqFlashSetAddress] = { - .code = 0x802, - .data_size = 0x4000, - .need_ack = 1, - }, - [ReqFlashWriteBlock] = { - .code = 0x804, - .data_size = 0x4000, - .need_ack = 0, - } -}; - -static int galaxys2_send_image(struct ipc_client *client, - struct modemctl_io_data *io_data, enum xmm6260_image type) -{ - int ret = -1; - - if (type >= ARRAY_SIZE(galaxys2_radio_parts)) { - ipc_client_log(client, "Error: bad image type %x", type); - goto fail; - } - size_t length = galaxys2_radio_parts[type].length; - size_t offset = galaxys2_radio_parts[type].offset; - - size_t start = offset; - size_t end = length + start; - - //dump some image bytes - ipc_client_log(client, "image start"); - - while (start < end) { - ret = write(io_data->boot_fd, io_data->radio_data + start, end - start); - if (ret < 0) { - ipc_client_log(client, "failed to write image chunk"); - goto fail; - } - start += ret; - } - - unsigned char crc = xmm6260_crc_calculate(io_data->radio_data, offset, length); - - if ((ret = write(io_data->boot_fd, &crc, 1)) < 1) { - ipc_client_log(client, "failed to write CRC"); - goto fail; - } - else { - ipc_client_log(client, "wrote CRC %x", crc); - } - - return 0; - -fail: - return ret; -} - -static int galaxys2_send_psi(struct ipc_client *client, struct modemctl_io_data *io_data) -{ - size_t length = galaxys2_radio_parts[PSI].length; - - struct galaxys2_psi_header hdr = { - .magic = XMM_PSI_MAGIC, - .length = length, - .padding = 0xff, - }; - int ret = -1; - - if ((ret = write(io_data->boot_fd, &hdr, sizeof(hdr))) != sizeof(hdr)) { - ipc_client_log(client, "%s: failed to write header, ret %d", __func__, ret); - goto fail; - } - - if ((ret = galaxys2_send_image(client, io_data, PSI)) < 0) { - ipc_client_log(client, "Error: failed to send PSI image"); - goto fail; - } - - int i; - for (i = 0; i < 22; i++) { - char ack; - if (expect_read(io_data->boot_fd, &ack, 1) < 1) { - ipc_client_log(client, "failed to read ACK byte %d", i); - goto fail; - } - } - - if ((ret = expect_data(io_data->boot_fd, "\x1", 1)) < 0) { - ipc_client_log(client, "failed to wait for first ACK"); - goto fail; - } - - if ((ret = expect_data(io_data->boot_fd, "\x1", 1)) < 0) { - ipc_client_log(client, "failed to wait for second ACK"); - goto fail; - } - - if ((ret = expect_data(io_data->boot_fd, PSI_ACK_MAGIC, 2)) < 0) { - ipc_client_log(client, "Error: failed to receive PSI ACK"); - goto fail; - } - else { - ipc_client_log(client, "received PSI ACK"); - } - - return 0; - -fail: - return ret; -} - -static int galaxys2_send_ebl(struct ipc_client *client, struct modemctl_io_data *io_data) -{ - int ret; - int fd = io_data->boot_fd; - unsigned length = galaxys2_radio_parts[EBL].length; - - if ((ret = write(fd, &length, sizeof(length))) < 0) { - ipc_client_log(client, "Error: failed to write EBL length"); - goto fail; - } - - if ((ret = expect_data(fd, EBL_HDR_ACK_MAGIC, 2)) < 0) { - ipc_client_log(client, "Error: failed to wait for EBL header ACK"); - goto fail; - } - - if ((ret = galaxys2_send_image(client, io_data, EBL)) < 0) { - ipc_client_log(client, "Error: failed to send EBL image"); - goto fail; - } - - if ((ret = expect_data(fd, EBL_IMG_ACK_MAGIC, 2)) < 0) { - ipc_client_log(client, "Error: failed to wait for EBL image ACK"); - goto fail; - } - - return 0; - -fail: - return ret; -} - -static int galaxys2_boot_cmd(struct ipc_client *client, - struct modemctl_io_data *io_data, enum xmm6260_boot_cmd cmd, - void *data, size_t data_size) -{ - int ret = 0; - char *cmd_data = 0; - if (cmd >= ARRAY_SIZE(galaxys2_boot_cmd_desc)) { - ipc_client_log(client, "Error: bad command %x\n", cmd); - goto done_or_fail; - } - - unsigned cmd_code = galaxys2_boot_cmd_desc[cmd].code; - - uint16_t magic = (data_size & 0xffff) + cmd_code; - unsigned char *ptr = (unsigned char*)data; - size_t i; - for (i = 0; i < data_size; i++) { - magic += ptr[i]; - } - - struct galaxys2_boot_cmd header = { - .check = magic, - .cmd = cmd_code, - .data_size = data_size, - }; - - size_t cmd_size = galaxys2_boot_cmd_desc[cmd].data_size; - size_t buf_size = cmd_size + sizeof(header); - - cmd_data = (char*)malloc(buf_size); - if (!cmd_data) { - ipc_client_log(client, "Error: failed to allocate command buffer"); - ret = -ENOMEM; - goto done_or_fail; - } - memset(cmd_data, 0, buf_size); - memcpy(cmd_data, &header, sizeof(header)); - memcpy(cmd_data + sizeof(header), data, data_size); - - if ((ret = write(io_data->boot_fd, cmd_data, buf_size)) < 0) { - ipc_client_log(client, "Error: failed to write command to socket"); - goto done_or_fail; - } - - if ((unsigned)ret != buf_size) { - ipc_client_log(client, "Error: written %d bytes of %d", ret, buf_size); - ret = -EINVAL; - goto done_or_fail; - } - - if (!galaxys2_boot_cmd_desc[cmd].need_ack) { - ret = 0; - goto done_or_fail; - } - - struct galaxys2_boot_cmd ack = { - .check = 0, - }; - if ((ret = expect_read(io_data->boot_fd, &ack, sizeof(ack))) < 0) { - ipc_client_log(client, "Error: failed to receive ack for cmd %x", header.cmd); - goto done_or_fail; - } - - if (ret != sizeof(ack)) { - ipc_client_log(client, "Error: received %x bytes of %x for ack", ret, sizeof(ack)); - ret = -EINVAL; - goto done_or_fail; - } - - if (ack.cmd != header.cmd) { - ipc_client_log(client, "Error: ack cmd %x does not match request %x", ack.cmd, header.cmd); - ret = -EINVAL; - goto done_or_fail; - } - - if ((ret = expect_read(io_data->boot_fd, cmd_data, cmd_size)) < 0) { - ipc_client_log(client, "Error: failed to receive reply data"); - goto done_or_fail; - } - - if ((unsigned)ret != cmd_size) { - ipc_client_log(client, "Error: received %x bytes of %x for reply data", ret, cmd_size); - ret = -EINVAL; - goto done_or_fail; - } - -done_or_fail: - - if (cmd_data) { - free(cmd_data); - } - - return ret; -} - -static int galaxys2_boot_info_ack(struct ipc_client *client, - struct modemctl_io_data *io_data) -{ - int ret; - struct galaxys2_boot_info info; - - if ((ret = expect_read(io_data->boot_fd, &info, sizeof(info))) != sizeof(info)) { - ipc_client_log(client, "Error: failed to receive Boot Info ret=%d", ret); - ret = -1; - goto fail; - } - else { - ipc_client_log(client, "received Boot Info"); - } - - if ((ret = galaxys2_boot_cmd(client, io_data, SetPortConf, &info, sizeof(info))) < 0) { - ipc_client_log(client, "Error: failed to send SetPortConf command"); - goto fail; - } - else { - ipc_client_log(client, "sent SetPortConf command"); - } - - return 0; - -fail: - return ret; -} - -static int galaxys2_send_image_data(struct ipc_client *client, - struct modemctl_io_data *io_data, uint32_t addr, - void *data, int data_len) -{ - int ret = 0; - int count = 0; - char *data_p = (char *) data; - - if ((ret = galaxys2_boot_cmd(client, io_data, ReqFlashSetAddress, &addr, 4)) < 0) { - ipc_client_log(client, "Error: failed to send ReqFlashSetAddress"); - goto fail; - } - else { - ipc_client_log(client, "sent ReqFlashSetAddress"); - } - - while (count < data_len) { - int rest = data_len - count; - int chunk = rest < SEC_DOWNLOAD_CHUNK ? rest : SEC_DOWNLOAD_CHUNK; - - ret = galaxys2_boot_cmd(client, io_data, ReqFlashWriteBlock, data_p, chunk); - if (ret < 0) { - ipc_client_log(client, "Error: failed to send data chunk"); - goto fail; - } - - data_p += chunk; - count += chunk; - } - - usleep(SEC_DOWNLOAD_DELAY_US); - -fail: - return ret; -} - -static int galaxys2_send_image_addr(struct ipc_client *client, - struct modemctl_io_data *io_data, uint32_t addr, enum xmm6260_image type) -{ - uint32_t offset = galaxys2_radio_parts[type].offset; - uint32_t length = galaxys2_radio_parts[type].length; - char *start = io_data->radio_data + offset; - int ret = 0; - - ret = galaxys2_send_image_data(client, io_data, addr, start, length); - - return ret; -} - -static int galaxys2_send_secure_images(struct ipc_client *client, - struct modemctl_io_data *io_data) -{ - int ret = 0; - - uint32_t sec_off = galaxys2_radio_parts[SECURE_IMAGE].offset; - uint32_t sec_len = galaxys2_radio_parts[SECURE_IMAGE].length; - void *sec_img = io_data->radio_data + sec_off; - void *nv_data = NULL; - - if ((ret = galaxys2_boot_cmd(client, io_data, ReqSecStart, sec_img, sec_len)) < 0) { - ipc_client_log(client, "Error: failed to write ReqSecStart"); - goto fail; - } - else { - ipc_client_log(client, "sent ReqSecStart"); - } - - if ((ret = galaxys2_send_image_addr(client, io_data, FW_LOAD_ADDR, FIRMWARE)) < 0) { - ipc_client_log(client, "Error: failed to send FIRMWARE image"); - goto fail; - } - else { - ipc_client_log(client, "sent FIRMWARE image"); - } - - if (nv_data_check(client) < 0) - goto fail; - - if (nv_data_md5_check(client) < 0) - goto fail; - - nv_data = ipc_client_file_read(client, nv_data_path(client), 2 << 20, 1024); - if (nv_data == NULL) { - ipc_client_log(client, "Error: failed to read NVDATA image"); - goto fail; - } - - if ((ret = galaxys2_send_image_data(client, io_data, NVDATA_LOAD_ADDR, nv_data, 2 << 20)) < 0) { - ipc_client_log(client, "Error: failed to send NVDATA image"); - goto fail; - } - else { - ipc_client_log(client, "sent NVDATA image"); - } - - free(nv_data); - - if ((ret = galaxys2_boot_cmd(client, io_data, ReqSecEnd, - BL_END_MAGIC, BL_END_MAGIC_LEN)) < 0) - { - ipc_client_log(client, "Error: failed to write ReqSecEnd"); - goto fail; - } - else { - ipc_client_log(client, "sent ReqSecEnd"); - } - - ret = galaxys2_boot_cmd(client, io_data, ReqForceHwReset, - BL_RESET_MAGIC, BL_RESET_MAGIC_LEN); - if (ret < 0) { - ipc_client_log(client, "Error: failed to write ReqForceHwReset"); - goto fail; - } - else { - ipc_client_log(client, "sent ReqForceHwReset"); - } - -fail: - return ret; -} - -/* - * i9200 (Galaxy S2) board-specific code - */ - -/* - * Power management - */ -static int galaxys2_ehci_setpower(struct ipc_client *client, bool enabled) { - int ret = -1; - - ipc_client_log(client, "%s: enabled=%d", __func__, enabled); - - int ehci_fd = open(I9100_EHCI_PATH, O_RDWR); - if (ehci_fd < 0) { - ipc_client_log(client, "Error: failed to open EHCI fd"); - ret = -ENODEV; - goto fail; - } - else { - ipc_client_log(client, "opened EHCI %s: fd=%d", I9100_EHCI_PATH, ehci_fd); - } - - ret = write(ehci_fd, enabled ? "1" : "0", 1); - - //must write exactly one byte - if (ret <= 0) { - ipc_client_log(client, "Error: failed to set EHCI power"); - } - else { - ipc_client_log(client, "set EHCI power"); - } - -fail: - if (ehci_fd >= 0) { - close(ehci_fd); - } - - return ret; -} - -static int galaxys2_modem_reboot(struct ipc_client *client, - struct modemctl_io_data *io_data, bool hard) { - int ret; - - //wait for link to become ready before redetection - if (!hard) { - if ((ret = modemctl_wait_link_ready(client, io_data)) < 0) { - ipc_client_log(client, "Error: failed to wait for link to get ready for redetection"); - goto fail; - } - else { - ipc_client_log(client, "link ready for redetection"); - } - } - - /* - * Disable the hardware to ensure consistent state - */ - if (hard) { - if ((ret = modemctl_modem_power(client, io_data, false)) < 0) { - ipc_client_log(client, "Error: failed to disable xmm6260 power"); - goto fail; - } - else { - ipc_client_log(client, "disabled xmm6260 power"); - } - } - - if ((ret = modemctl_link_set_enabled(client, io_data, false)) < 0) { - ipc_client_log(client, "Error: failed to disable I9100 HSIC link"); - goto fail; - } - else { - ipc_client_log(client, "disabled I9100 HSIC link"); - } - - if ((ret = galaxys2_ehci_setpower(client, false)) < 0) { - ipc_client_log(client, "Error: failed to disable I9100 EHCI"); - goto fail; - } - else { - ipc_client_log(client, "disabled I9100 EHCI"); - } - - if ((ret = modemctl_link_set_active(client, io_data, false)) < 0) { - ipc_client_log(client, "Error: failed to deactivate I9100 HSIC link"); - goto fail; - } - else { - ipc_client_log(client, "deactivated I9100 HSIC link"); - } - - /* - * Now, initialize the hardware - */ - - if ((ret = modemctl_link_set_enabled(client, io_data, true)) < 0) { - ipc_client_log(client, "Error: failed to enable I9100 HSIC link"); - goto fail; - } - else { - ipc_client_log(client, "enabled I9100 HSIC link"); - } - - if ((ret = galaxys2_ehci_setpower(client, true)) < 0) { - ipc_client_log(client, "Error: failed to enable I9100 EHCI"); - goto fail; - } - else { - ipc_client_log(client, "enabled I9100 EHCI"); - } - - if ((ret = modemctl_link_set_active(client, io_data, true)) < 0) { - ipc_client_log(client, "Error: failed to activate I9100 HSIC link"); - goto fail; - } - else { - ipc_client_log(client, "activated I9100 HSIC link"); - } - - if (hard) { - if ((ret = modemctl_modem_power(client, io_data, true)) < 0) { - ipc_client_log(client, "Error: failed to enable xmm6260 power"); - goto fail; - } - else { - ipc_client_log(client, "enabled xmm6260 power"); - } - } - - if ((ret = modemctl_wait_link_ready(client, io_data)) < 0) { - ipc_client_log(client, "Error: failed to wait for link to get ready"); - goto fail; - } - else { - ipc_client_log(client, "link ready"); - } - -fail: - return ret; -} - -int galaxys2_ipc_bootstrap(struct ipc_client *client) { - int ret = 0; - struct modemctl_io_data io_data; - memset(&io_data, 0, sizeof(client, io_data)); - - io_data.radio_fd = open(RADIO_IMAGE, O_RDONLY); - if (io_data.radio_fd < 0) { - ipc_client_log(client, "Error: failed to open radio firmware"); - goto fail; - } - else { - ipc_client_log(client, "opened radio image %s, fd=%d", RADIO_IMAGE, io_data.radio_fd); - } - - if (fstat(io_data.radio_fd, &io_data.radio_stat) < 0) { - ipc_client_log(client, "Error: failed to stat radio image, error %s", strerror(errno)); - goto fail; - } - - io_data.radio_data = mmap(0, RADIO_MAP_SIZE, PROT_READ, MAP_SHARED, - io_data.radio_fd, 0); - if (io_data.radio_data == MAP_FAILED) { - ipc_client_log(client, "Error: failed to mmap radio image, error %s", strerror(errno)); - goto fail; - } - - io_data.boot_fd = open(BOOT_DEV, O_RDWR | O_NOCTTY | O_NONBLOCK); - if (io_data.boot_fd < 0) { - ipc_client_log(client, "Error: failed to open boot device"); - goto fail; - } - else { - ipc_client_log(client, "opened boot device %s, fd=%d", BOOT_DEV, io_data.boot_fd); - } - - io_data.link_fd = open(LINK_PM, O_RDWR); - if (io_data.link_fd < 0) { - ipc_client_log(client, "Error: failed to open link device"); - goto fail; - } - else { - ipc_client_log(client, "opened link device %s, fd=%d", LINK_PM, io_data.link_fd); - } - - if (galaxys2_modem_reboot(client, &io_data, true)) { - ipc_client_log(client, "Error: failed to hard reset modem"); - goto fail; - } - else { - ipc_client_log(client, "modem hard reset done"); - } - - /* - * Now, actually load the firmware - */ - if (write(io_data.boot_fd, "ATAT", 4) != 4) { - ipc_client_log(client, "Error: failed to write ATAT to boot socket"); - goto fail; - } - else { - ipc_client_log(client, "written ATAT to boot socket, waiting for ACK"); - } - - char buf[2]; - if (expect_read(io_data.boot_fd, buf, 1) < 0) { - ipc_client_log(client, "Error: failed to receive bootloader ACK"); - goto fail; - } - if (expect_read(io_data.boot_fd, buf + 1, 1) < 0) { - ipc_client_log(client, "Error: failed to receive chip IP ACK"); - goto fail; - } - ipc_client_log(client, "receive ID: [%02x %02x]", buf[0], buf[1]); - - if ((ret = galaxys2_send_psi(client, &io_data)) < 0) { - ipc_client_log(client, "Error: failed to upload PSI"); - goto fail; - } - else { - ipc_client_log(client, "PSI download complete"); - } - - if ((ret = galaxys2_send_ebl(client, &io_data)) < 0) { - ipc_client_log(client, "Error: failed to upload EBL"); - goto fail; - } - else { - ipc_client_log(client, "EBL download complete"); - } - - if ((ret = galaxys2_boot_info_ack(client, &io_data)) < 0) { - ipc_client_log(client, "Error: failed to receive Boot Info"); - goto fail; - } - else { - ipc_client_log(client, "Boot Info ACK done"); - } - - if ((ret = galaxys2_send_secure_images(client, &io_data)) < 0) { - ipc_client_log(client, "Error: failed to upload Secure Image"); - goto fail; - } - else { - ipc_client_log(client, "Secure Image download complete"); - } - - usleep(POST_BOOT_TIMEOUT_US); - - if ((ret = galaxys2_modem_reboot(client, &io_data, false))) { - ipc_client_log(client, "Error: failed to soft reset modem"); - goto fail; - } - else { - ipc_client_log(client, "modem soft reset done"); - } - - ipc_client_log(client, "Modem is online!"); - ret = 0; - -fail: - if (io_data.radio_data != MAP_FAILED) { - munmap(io_data.radio_data, RADIO_MAP_SIZE); - } - - if (io_data.link_fd >= 0) { - close(io_data.link_fd); - } - - if (io_data.radio_fd >= 0) { - close(io_data.radio_fd); - } - - if (io_data.boot_fd >= 0) { - close(io_data.boot_fd); - } - - return ret; -} - -// vim:ts=4:sw=4:expandtab diff --git a/samsung-ipc/device/galaxys2/galaxys2_loader.h b/samsung-ipc/device/galaxys2/galaxys2_loader.h deleted file mode 100644 index e300d70..0000000 --- a/samsung-ipc/device/galaxys2/galaxys2_loader.h +++ /dev/null @@ -1,82 +0,0 @@ -/* - * Firmware loader for Samsung I9100 (galaxys2) - * Copyright (C) 2012 Alexander Tarasikov <alexander.tarasikov@gmail.com> - * Copyright (C) 2012 Paul Kocialkowski <contact@paulk.fr> - * - * based on the incomplete C++ implementation which is - * Copyright (C) 2012 Sergey Gridasov <grindars@gmail.com> - * - * This program is free software: you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation, either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program. If not, see <http://www.gnu.org/licenses/>. - */ - -#include <stdbool.h> -#include <stdint.h> -#include <stdlib.h> - -#ifndef __GALAXYS2_LOADER_H__ -#define __GALAXYS2_LOADER_H__ - -#define RADIO_IMAGE "/dev/block/mmcblk0p8" -#define I9100_EHCI_PATH "/sys/devices/platform/s5p-ehci/ehci_power" - -#define LINK_POLL_DELAY_US (50 * 1000) -#define LINK_TIMEOUT_MS 2000 - -#define XMM_PSI_MAGIC 0x30 -#define PSI_ACK_MAGIC "\x00\xaa" - -#define EBL_HDR_ACK_MAGIC "\xcc\xcc" -#define EBL_IMG_ACK_MAGIC "\x51\xa5" - -#define BL_END_MAGIC "\x00\x00" -#define BL_END_MAGIC_LEN 2 - -#define BL_RESET_MAGIC "\x01\x10\x11\x00" -#define BL_RESET_MAGIC_LEN 4 - -#define SEC_DOWNLOAD_CHUNK 16384 -#define SEC_DOWNLOAD_DELAY_US (500 * 1000) - -#define POST_BOOT_TIMEOUT_US (600 * 1000) - -#define FW_LOAD_ADDR 0x60300000 -#define NVDATA_LOAD_ADDR 0x60e80000 - -struct galaxys2_boot_cmd_desc { - unsigned code; - size_t data_size; - bool need_ack; -}; - -struct galaxys2_psi_header { - uint8_t magic; - uint16_t length; - uint8_t padding; -} __attribute__((packed)); - -struct galaxys2_boot_info { - uint8_t data[76]; -} __attribute__((packed)); - -struct galaxys2_boot_cmd { - uint16_t check; - uint16_t cmd; - uint32_t data_size; -} __attribute__((packed)); - -int galaxys2_ipc_bootstrap(struct ipc_client *client); - -#endif - -// vim:ts=4:sw=4:expandtab |