yetangitu/fernly
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity
fernly/flashrom-fernvale.patch

349 lines
8.1 KiB
Diff
Raw Permalink Blame History

This patch adds "fernvale_spi" "programmer" for "flashrom" utility
http://flashrom.org/ . It allows read or program FlashROM on a
Mediatek MT6260 device using "fernly" bootloader
https://github.com/xobs/fernly .
Author: Sean Cross <xobs@kosagi.com>
Index: Makefile
===================================================================
--- Makefile (revision 1897)
+++ Makefile (working copy)
@@ -272,6 +272,11 @@
else
override CONFIG_BUSPIRATE_SPI = no
endif
+ifeq ($(CONFIG_FERNVALE_SPI), yes)
+UNSUPPORTED_FEATURES += CONFIG_FERNVALE_SPI=yes
+else
+override CONFIG_FERNVALE_SPI = no
+endif
ifeq ($(CONFIG_SERPROG), yes)
UNSUPPORTED_FEATURES += CONFIG_SERPROG=yes
else
@@ -469,6 +474,9 @@
# Always enable Bus Pirate SPI for now.
CONFIG_BUSPIRATE_SPI ?= yes
+# Always enable Fernvale SPI, too
+CONFIG_FERNVALE_SPI ?= yes
+
# Disable Dediprog SF100 until support is complete and tested.
CONFIG_DEDIPROG ?= no
@@ -694,6 +702,12 @@
NEED_SERIAL := yes
endif
+ifeq ($(CONFIG_FERNVALE_SPI), yes)
+FEATURE_CFLAGS += -D'CONFIG_FERNVALE_SPI=1'
+PROGRAMMER_OBJS += fernvale_spi.o
+NEED_SERIAL := yes
+endif
+
ifeq ($(CONFIG_DEDIPROG), yes)
FEATURE_CFLAGS += -D'CONFIG_DEDIPROG=1'
PROGRAMMER_OBJS += dediprog.o
Index: fernvale_spi.c
===================================================================
--- fernvale_spi.c (revision 0)
+++ fernvale_spi.c (working copy)
@@ -0,0 +1,238 @@
+/*
+ * This file is part of the flashrom project.
+ *
+ * Copyright (C) 2009, 2010 Carl-Daniel Hailfinger
+ *
+ * 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; version 2 of the License.
+ *
+ * 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, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <ctype.h>
+#include <fcntl.h>
+#include <sys/types.h>
+#include <unistd.h>
+#include <errno.h>
+#include <termios.h>
+
+#include "flash.h"
+#include "programmer.h"
+#include "spi.h"
+
+#define DEFAULT_DEV "/dev/fernvale"
+#define BAUDRATE B921600
+
+static struct {
+ int fd;
+} fernvale_data;
+
+static int fernvale_spi_send_command(struct flashctx *flash,
+ unsigned int writecnt, unsigned int readcnt,
+ const unsigned char *writearr,
+ unsigned char *readarr);
+
+static const struct spi_master spi_master_fernvale = {
+ .type = SPI_CONTROLLER_FERNVALE,
+ .max_data_read = 128,
+ .max_data_write = 128,
+ .command = fernvale_spi_send_command,
+ .multicommand = default_spi_send_multicommand,
+ .read = default_spi_read,
+ .write_256 = default_spi_write_256,
+ .write_aai = default_spi_write_aai,
+};
+
+static int fernvale_spi_shutdown(void *data)
+{
+ const char cmd[] = { 0, 0 };
+
+ write(fernvale_data.fd, cmd, sizeof(cmd));
+
+ return 0;
+}
+
+static int fernvale_spi_setserial(int serfd)
+{
+ int ret;
+ struct termios t;
+
+ ret = tcgetattr(serfd, &t);
+ if (-1 == ret) {
+ perror("Failed to get attributes");
+ exit(1);
+ }
+ cfsetispeed(&t, BAUDRATE);
+ cfsetospeed(&t, BAUDRATE);
+ cfmakeraw(&t);
+ ret = tcsetattr(serfd, TCSANOW, &t);
+ if (-1 == ret) {
+ perror("Failed to set attributes");
+ exit(1);
+ }
+
+ return 0;
+}
+
+int fernvale_spi_init(void)
+{
+ struct spi_master mst = spi_master_fernvale;
+ char *dev;
+
+ dev = extract_programmer_param("dev");
+ if (dev && !strlen(dev)) {
+ free(dev);
+ dev = NULL;
+ }
+ if (!dev)
+ dev = DEFAULT_DEV;
+
+ fernvale_data.fd = open(dev, O_RDWR);
+ if (fernvale_data.fd == -1) {
+ msg_perr("Unable to open serial device. "
+ "Use flashrom -p fernvale_spi:dev=/dev/ttyUSB0\n");
+ return 1;
+ }
+
+ fernvale_spi_setserial(fernvale_data.fd);
+
+ const char cmd[] = "spi flashrom\n";
+ char readback;
+ int ready_tries = 0;
+ write(fernvale_data.fd, cmd, strlen(cmd));
+
+ /* Look for "Ready" signal */
+ do {
+ read(fernvale_data.fd, &readback, sizeof(readback));
+ ready_tries++;
+ } while (readback != 0x05);
+ msg_gdbg("Found 'ready' signal after %d bytes\n", ready_tries);
+
+ mst.data = &fernvale_data;
+ register_spi_master(&mst);
+ register_shutdown(fernvale_spi_shutdown, NULL);
+
+ return 0;
+}
+
+static int write_full(int fd, const void *bfr, int size)
+{
+ int ret;
+ int left = size;
+
+ while (left > 0) {
+ ret = write(fd, bfr, left);
+ if (ret == -1) {
+ if (errno == EAGAIN)
+ continue;
+ return ret;
+ }
+
+ /* FD closed */
+ if (!ret)
+ return -1;
+
+ left -= ret;
+ bfr += ret;
+ }
+ return size;
+}
+
+static int read_full(int fd, void *bfr, int size)
+{
+ int ret;
+ int left = size;
+
+ msg_gdbg(" Reading %d bytes:", size);
+ while (left > 0) {
+ ret = read(fd, bfr, 1);
+ if (ret == -1) {
+ if (errno == EAGAIN)
+ continue;
+ return ret;
+ }
+ msg_gdbg(" 0x%02x:", *((uint8_t *)bfr));
+
+ /* FD closed */
+ if (!ret)
+ return -1;
+
+ left -= ret;
+ bfr += ret;
+ }
+ return size;
+}
+
+static int fernvale_spi_send_command(struct flashctx *flash,
+ unsigned int writecnt, unsigned int readcnt,
+ const unsigned char *writearr,
+ unsigned char *readarr)
+{
+ uint8_t out_bytes = writecnt;
+ uint8_t in_bytes = readcnt;
+ int ret;
+ int fd = fernvale_data.fd;
+ int i;
+#if 1
+ ret = write_full(fd, &out_bytes, sizeof(out_bytes));
+ if (ret != sizeof(out_bytes))
+ msg_perr("0: Wanted to write %d bytes, but got %d\n",
+ (int)sizeof(out_bytes), ret);
+
+ ret = write_full(fd, &in_bytes, sizeof(in_bytes));
+ if (ret != sizeof(in_bytes))
+ msg_perr("1: Wanted to write %d bytes, but got %d\n",
+ (int)sizeof(in_bytes), ret);
+
+ ret = write_full(fd, writearr, out_bytes);
+ if (ret != out_bytes)
+ msg_perr("0: Wanted to write %d bytes, but got %d\n",
+ out_bytes, ret);
+
+ msg_gdbg(" Wrote %d bytes:", out_bytes);
+ for (i = 0; i < out_bytes; i++)
+ msg_gdbg(" %02x", writearr[i]);
+ msg_gdbg(" ");
+#else
+ uint8_t bfr[writecnt + 2];
+
+ bfr[0] = out_bytes;
+ bfr[1] = in_bytes;
+ memcpy(&bfr[2], writearr, out_bytes);
+
+ ret = write_full(fd, bfr, sizeof(bfr));
+ if (ret != sizeof(bfr))
+ msg_perr("0: Wanted to write %d bytes, but got %d\n",
+ sizeof(bfr), ret);
+
+ msg_gdbg(" Wrote %d bytes:", sizeof(bfr));
+ for (i = 0; i < sizeof(bfr); i++)
+ msg_gdbg(" %02x", bfr[i]);
+ msg_gdbg(" ");
+#endif
+
+ ret = read_full(fd, readarr, in_bytes);
+ if (ret != in_bytes)
+ msg_perr("3: Wanted to read %d bytes, but got %d\n",
+ in_bytes, ret);
+
+ msg_gdbg(" Read %d bytes:", in_bytes);
+ for (i = 0; i < in_bytes; i++)
+ msg_gdbg(" %02x", readarr[i]);
+ msg_gdbg(" ");
+
+ msg_gdbg("\n");
+
+ return 0;
+}
Index: flashrom.c
===================================================================
--- flashrom.c (revision 1897)
+++ flashrom.c (working copy)
@@ -231,6 +231,19 @@
},
#endif
+#if CONFIG_FERNVALE_SPI == 1
+ {
+ .name = "fernvale_spi",
+ .type = OTHER,
+ /* FIXME */
+ .devs.note = "Kosagi Fernvale\n",
+ .init = fernvale_spi_init,
+ .map_flash_region = fallback_map,
+ .unmap_flash_region = fallback_unmap,
+ .delay = internal_delay,
+ },
+#endif
+
#if CONFIG_DEDIPROG == 1
{
.name = "dediprog",
Index: programmer.h
===================================================================
--- programmer.h (revision 1897)
+++ programmer.h (working copy)
@@ -69,6 +69,9 @@
#if CONFIG_BUSPIRATE_SPI == 1
PROGRAMMER_BUSPIRATE_SPI,
#endif
+#if CONFIG_FERNVALE_SPI == 1
+ PROGRAMMER_FERNVALE_SPI,
+#endif
#if CONFIG_DEDIPROG == 1
PROGRAMMER_DEDIPROG,
#endif
@@ -506,6 +509,11 @@
int buspirate_spi_init(void);
#endif
+/* fernvale_spi.c */
+#if CONFIG_FERNVALE_SPI == 1
+int fernvale_spi_init(void);
+#endif
+
/* linux_spi.c */
#if CONFIG_LINUX_SPI == 1
int linux_spi_init(void);
@@ -554,6 +562,9 @@
#if CONFIG_BUSPIRATE_SPI == 1
SPI_CONTROLLER_BUSPIRATE,
#endif
+#if CONFIG_FERNVALE_SPI == 1
+ SPI_CONTROLLER_FERNVALE,
+#endif
#if CONFIG_DEDIPROG == 1
SPI_CONTROLLER_DEDIPROG,
#endif
Reference in a new issue View git blame Copy permalink