From 13a2ef6cbd0838a7965914dda3b4a63ff4ae5440 Mon Sep 17 00:00:00 2001
From: Shiyu Sun <sshiyu@google.com>
Date: Thu, 19 Mar 2020 14:37:57 +1100
Subject: lspcon_i2c_spi.c: Add SPI-master support for PS17{5,6}

This adds support for the Parade lspcon usb-c to HDMI protocol
translater part that is i2c-controlled. The support allows the
host to reach the SPI ROM that hangs off the part where it
stores its firmware.

Usage is as follows:
	flashrom -p lspcon_i2c_spi:bus=X
	where X is the bus number.

BUG=b:148746232
BRANCH=none
TEST=tested with following commands, read/write/erase works good.
	flashrom -p lspcon_i2c_spi:bus=7 -r /tmp/foo;
	flashrom -p lspcon_i2c_spi:bus=7 -E;
	flashrom -p lspcon_i2c_spi:bus=7 -w /tmp/foo;

Change-Id: I039e683252cfaf1ffef8694a3e8081b1b6b944f7
Signed-off-by: Shiyu Sun <sshiyu@chromium.org>
Reviewed-on: https://review.coreboot.org/c/flashrom/+/39687
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
Reviewed-by: Edward O'Callaghan <quasisec@chromium.org>
---
 Makefile          |  25 +++
 flashrom.c        |  12 ++
 lspcon_i2c_spi.c  | 505 ++++++++++++++++++++++++++++++++++++++++++++++++++++++
 meson.build       |   5 +
 meson_options.txt |   1 +
 programmer.h      |   8 +
 6 files changed, 556 insertions(+)
 create mode 100644 lspcon_i2c_spi.c

diff --git a/Makefile b/Makefile
index 433d8f76..a533acf3 100644
--- a/Makefile
+++ b/Makefile
@@ -195,6 +195,11 @@ UNSUPPORTED_FEATURES += CONFIG_STLINKV3_SPI=yes
 else
 override CONFIG_STLINKV3_SPI = no
 endif
+ifeq ($(CONFIG_LSPCON_I2C_SPI), yes)
+UNSUPPORTED_FEATURES += CONFIG_LSPCON_I2C_SPI=yes
+else
+override CONFIG_LSPCON_I2C_SPI = no
+endif
 # libjaylink is also not available for DOS
 ifeq ($(CONFIG_JLINK_SPI), yes)
 UNSUPPORTED_FEATURES += CONFIG_JLINK_SPI=yes
@@ -306,6 +311,11 @@ UNSUPPORTED_FEATURES += CONFIG_SATAMV=yes
 else
 override CONFIG_SATAMV = no
 endif
+ifeq ($(CONFIG_LSPCON_I2C_SPI), yes)
+UNSUPPORTED_FEATURES += CONFIG_LSPCON_I2C_SPI=yes
+else
+override CONFIG_LSPCON_I2C_SPI = no
+endif
 endif
 
 ifneq ($(TARGET_OS), MinGW)
@@ -381,6 +391,11 @@ UNSUPPORTED_FEATURES += CONFIG_STLINKV3_SPI=yes
 else
 override CONFIG_STLINKV3_SPI = no
 endif
+ifeq ($(CONFIG_LSPCON_I2C_SPI), yes)
+UNSUPPORTED_FEATURES += CONFIG_LSPCON_I2C_SPI=yes
+else
+override CONFIG_LSPCON_I2C_SPI = no
+endif
 ifeq ($(CONFIG_CH341A_SPI), yes)
 UNSUPPORTED_FEATURES += CONFIG_CH341A_SPI=yes
 else
@@ -656,6 +671,9 @@ CONFIG_PICKIT2_SPI ?= yes
 # Always enable STLink V3
 CONFIG_STLINKV3_SPI ?= yes
 
+# Disables LSPCON support until the i2c helper supports multiple systems.
+CONFIG_LSPCON_I2C_SPI ?= no
+
 # Always enable dummy tracing for now.
 CONFIG_DUMMY ?= yes
 
@@ -736,6 +754,7 @@ override CONFIG_DEVELOPERBOX_SPI = no
 override CONFIG_PICKIT2_SPI = no
 override CONFIG_RAIDEN = no
 override CONFIG_STLINKV3_SPI = no
+override CONFIG_LSPCON_I2C_SPI = no
 endif
 ifeq ($(CONFIG_ENABLE_LIBPCI_PROGRAMMERS), no)
 override CONFIG_INTERNAL = no
@@ -914,6 +933,12 @@ PROGRAMMER_OBJS += stlinkv3_spi.o
 NEED_LIBUSB1 += CONFIG_STLINKV3_SPI
 endif
 
+ifeq ($(CONFIG_LSPCON_I2C_SPI), yes)
+FEATURE_CFLAGS += -D'CONFIG_LSPCON_I2C_SPI=1'
+PROGRAMMER_OBJS += lspcon_i2c_spi.o
+NEED_LIBUSB1 += CONFIG_LSPCON_I2C_SPI
+endif
+
 ifneq ($(NEED_LIBFTDI), )
 FTDILIBS := $(call debug_shell,[ -n "$(PKG_CONFIG_LIBDIR)" ] && export PKG_CONFIG_LIBDIR="$(PKG_CONFIG_LIBDIR)" ; $(PKG_CONFIG) --libs libftdi1 || $(PKG_CONFIG) --libs libftdi || printf "%s" "-lftdi -lusb")
 FEATURE_CFLAGS += $(call debug_shell,grep -q "FT232H := yes" .features && printf "%s" "-D'HAVE_FT232H=1'")
diff --git a/flashrom.c b/flashrom.c
index 081b705d..07ce734b 100644
--- a/flashrom.c
+++ b/flashrom.c
@@ -389,6 +389,18 @@ const struct programmer_entry programmer_table[] = {
 	},
 #endif
 
+#if CONFIG_LSPCON_I2C_SPI == 1
+	{
+		.name			= "lspcon_i2c_spi",
+		.type			= OTHER,
+		.devs.note		= "Device files /dev/i2c-*.\n",
+		.init			= lspcon_i2c_spi_init,
+		.map_flash_region	= fallback_map,
+		.unmap_flash_region	= fallback_unmap,
+		.delay			= internal_delay,
+	},
+#endif
+
 #if CONFIG_USBBLASTER_SPI == 1
 	{
 		.name			= "usbblaster_spi",
diff --git a/lspcon_i2c_spi.c b/lspcon_i2c_spi.c
new file mode 100644
index 00000000..4c854264
--- /dev/null
+++ b/lspcon_i2c_spi.c
@@ -0,0 +1,505 @@
+/*
+ * This file is part of the flashrom project.
+ *
+ * Copyright (C) 2020 The Chromium OS Authors
+ *
+ * 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.
+ */
+
+#include <stdlib.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <string.h>
+#include <time.h>
+#include <errno.h>
+
+#include "programmer.h"
+#include "spi.h"
+#include "i2c_helper.h"
+
+#define REGISTER_ADDRESS	(0x94 >> 1)
+#define PAGE_ADDRESS		(0x9e >> 1)
+#define PAGE_SIZE		256
+#define MAX_SPI_WAIT_RETRIES	1000
+
+#define CLT2_SPI		0x82
+#define SPIEDID_BASE_ADDR2	0x8d
+#define ROMADDR_BYTE1		0x8e
+#define ROMADDR_BYTE2		0x8f
+#define SWSPI_WDATA		0x90
+ #define SWSPI_WDATA_CLEAR_STATUS		0x00
+ #define SWSPI_WDATA_WRITE_REGISTER		0x01
+ #define SWSPI_WDATA_READ_REGISTER		0x05
+ #define SWSPI_WDATA_ENABLE_REGISTER		0x06
+ #define SWSPI_WDATA_SECTOR_ERASE		0x20
+ #define SWSPI_WDATA_PROTECT_BP			0x8c
+#define SWSPI_RDATA		0x91
+#define SWSPI_LEN		0x92
+#define SWSPICTL		0x93
+ #define SWSPICTL_ACCESS_TRIGGER			1
+ #define SWSPICTL_CLEAR_PTR			(1 << 1)
+ #define SWSPICTL_NO_READ			(1 << 2)
+ #define SWSPICTL_ENABLE_READBACK		(1 << 3)
+ #define SWSPICTL_MOT				(1 << 4)
+#define SPISTATUS		0x9e
+ #define SPISTATUS_BYTE_PROGRAM_FINISHED		0
+ #define SPISTATUS_BYTE_PROGRAM_IN_IF		1
+ #define SPISTATUS_BYTE_PROGRAM_SEND_DONE	(1 << 1)
+ #define SPISTATUS_SECTOR_ERASE_FINISHED		0
+ #define SPISTATUS_SECTOR_ERASE_IN_IF		(1 << 2)
+ #define SPISTATUS_SECTOR_ERASE_SEND_DONE	(1 << 3)
+ #define SPISTATUS_CHIP_ERASE_FINISHED		0
+ #define SPISTATUS_CHIP_ERASE_IN_IF		(1 << 4)
+ #define SPISTATUS_CHIP_ERASE_SEND_DONE		(1 << 5)
+ #define SPISTATUS_FW_UPDATE_ENABLE		(1 << 6)
+#define WRITE_PROTECTION	0xb3
+ #define WRITE_PROTECTION_ON			0
+ #define WRITE_PROTECTION_OFF			0x10
+#define MPU			0xbc
+#define PAGE_HW_WRITE		0xda
+ #define PAGE_HW_WRITE_DISABLE			0
+ #define PAGE_HW_COFIG_REGISTER			0xaa
+ #define PAGE_HW_WRITE_ENABLE			0x55
+
+struct lspcon_i2c_spi_data {
+	int fd;
+};
+
+typedef struct {
+	uint8_t command;
+	const uint8_t *data;
+	uint8_t data_size;
+	uint8_t control;
+} packet_t;
+
+static int lspcon_i2c_spi_write_data(int fd, uint16_t addr, void *buf, uint16_t len)
+{
+	i2c_buffer_t data;
+	if (i2c_buffer_t_fill(&data, buf, len))
+		return SPI_GENERIC_ERROR;
+
+	return i2c_write(fd, addr, &data) == len ? 0 : SPI_GENERIC_ERROR;
+}
+
+static int lspcon_i2c_spi_read_data(int fd, uint16_t addr, void *buf, uint16_t len)
+{
+	i2c_buffer_t data;
+	if (i2c_buffer_t_fill(&data, buf, len))
+		return SPI_GENERIC_ERROR;
+
+	return i2c_read(fd, addr, &data) == len ? 0 : SPI_GENERIC_ERROR;
+}
+
+static int get_fd_from_context(struct flashctx *flash)
+{
+	if (!flash || !flash->mst || !flash->mst->spi.data) {
+		msg_perr("Unable to extract fd from flash context.\n");
+		return SPI_GENERIC_ERROR;
+	}
+        const struct lspcon_i2c_spi_data *data =
+		(const struct lspcon_i2c_spi_data *)flash->mst->spi.data;
+
+	return data->fd;
+}
+
+static int lspcon_i2c_spi_write_register(int fd, uint8_t i2c_register, uint8_t value)
+{
+	uint8_t command[] = { i2c_register, value };
+	return lspcon_i2c_spi_write_data(fd, REGISTER_ADDRESS, command, 2);
+}
+
+static int lspcon_i2c_spi_read_register(int fd, uint8_t i2c_register, uint8_t *value)
+{
+	uint8_t command[] = { i2c_register };
+	int ret = lspcon_i2c_spi_write_data(fd, REGISTER_ADDRESS, command, 1);
+	ret |= lspcon_i2c_spi_read_data(fd, REGISTER_ADDRESS, value, 1);
+
+	return ret ? SPI_GENERIC_ERROR : 0;
+}
+
+static int lspcon_i2c_spi_register_control(int fd, packet_t *packet)
+{
+	int i;
+	int ret = lspcon_i2c_spi_write_register(fd, SWSPI_WDATA, packet->command);
+	if (ret)
+		return ret;
+
+	/* Higher 4 bits are read size. */
+	int write_size = packet->data_size & 0x0f;
+	for (i = 0; i < write_size; ++i) {
+		ret |= lspcon_i2c_spi_write_register(fd, SWSPI_WDATA, packet->data[i]);
+	}
+
+	ret |= lspcon_i2c_spi_write_register(fd, SWSPI_LEN, packet->data_size);
+	ret |= lspcon_i2c_spi_write_register(fd, SWSPICTL, packet->control);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_wait_command_done(int fd, unsigned int offset, int mask)
+{
+	uint8_t val;
+	int tried = 0;
+	int ret = 0;
+	do {
+		ret |= lspcon_i2c_spi_read_register(fd, offset, &val);
+	} while(!ret && (val & mask) && ++tried < MAX_SPI_WAIT_RETRIES);
+
+	if (tried == MAX_SPI_WAIT_RETRIES) {
+		msg_perr("Error: Time out on sending command.\n");
+		return -MAX_SPI_WAIT_RETRIES;
+	}
+
+	return (val & mask) ? SPI_GENERIC_ERROR : ret;
+}
+
+static int lspcon_i2c_spi_wait_rom_free(int fd)
+{
+	uint8_t val;
+	int tried = 0;
+	int ret = 0;
+	ret |= lspcon_i2c_spi_wait_command_done(fd, SPISTATUS,
+		SPISTATUS_SECTOR_ERASE_IN_IF | SPISTATUS_SECTOR_ERASE_SEND_DONE);
+	if (ret)
+		return ret;
+
+	do {
+		packet_t packet = { SWSPI_WDATA_READ_REGISTER, NULL, 0,  SWSPICTL_ACCESS_TRIGGER };
+		ret |= lspcon_i2c_spi_register_control(fd, &packet);
+		ret |= lspcon_i2c_spi_wait_command_done(fd, SWSPICTL, SWSPICTL_ACCESS_TRIGGER);
+		ret |= lspcon_i2c_spi_read_register(fd, SWSPI_RDATA, &val);
+	} while (!ret && (val & SWSPICTL_ACCESS_TRIGGER) && ++tried < MAX_SPI_WAIT_RETRIES);
+
+	if (tried == MAX_SPI_WAIT_RETRIES) {
+		msg_perr("Error: Time out on waiting ROM free.\n");
+		return -MAX_SPI_WAIT_RETRIES;
+	}
+
+	return (val & SWSPICTL_ACCESS_TRIGGER) ? SPI_GENERIC_ERROR : ret;
+}
+
+static int lspcon_i2c_spi_toggle_register_protection(int fd, int toggle)
+{
+	return lspcon_i2c_spi_write_register(fd, WRITE_PROTECTION,
+		toggle ? WRITE_PROTECTION_OFF : WRITE_PROTECTION_ON);
+}
+
+static int lspcon_i2c_spi_enable_write_status_register(int fd)
+{
+	int ret = lspcon_i2c_spi_toggle_register_protection(fd, 1);
+	packet_t packet = {
+		SWSPI_WDATA_ENABLE_REGISTER, NULL, 0, SWSPICTL_ACCESS_TRIGGER | SWSPICTL_NO_READ };
+	ret |= lspcon_i2c_spi_register_control(fd, &packet);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 0);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_enable_write_status_register_protection(int fd)
+{
+	int ret = lspcon_i2c_spi_toggle_register_protection(fd, 1);
+	uint8_t data[] = { SWSPI_WDATA_PROTECT_BP };
+	packet_t packet = {
+		SWSPI_WDATA_WRITE_REGISTER, data, 1, SWSPICTL_ACCESS_TRIGGER | SWSPICTL_NO_READ };
+	ret |= lspcon_i2c_spi_register_control(fd, &packet);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 0);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_disable_protection(int fd)
+{
+	int ret = lspcon_i2c_spi_toggle_register_protection(fd, 1);
+	uint8_t data[] = { SWSPI_WDATA_CLEAR_STATUS };
+	packet_t packet = {
+		SWSPI_WDATA_WRITE_REGISTER, data, 1, SWSPICTL_ACCESS_TRIGGER | SWSPICTL_NO_READ };
+	ret |= lspcon_i2c_spi_register_control(fd, &packet);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 0);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_disable_hw_write(int fd)
+{
+	return lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, PAGE_HW_WRITE_DISABLE);
+}
+
+static int lspcon_i2c_spi_enable_write_protection(int fd)
+{
+	int ret = lspcon_i2c_spi_enable_write_status_register(fd);
+	ret |= lspcon_i2c_spi_enable_write_status_register_protection(fd);
+	ret |= lspcon_i2c_spi_wait_rom_free(fd);
+	ret |= lspcon_i2c_spi_disable_hw_write(fd);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_disable_all_protection(int fd)
+{
+	int ret = lspcon_i2c_spi_enable_write_status_register(fd);
+	ret |= lspcon_i2c_spi_disable_protection(fd);
+	ret |= lspcon_i2c_spi_wait_rom_free(fd);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_send_command(struct flashctx *flash,
+				unsigned int writecnt, unsigned int readcnt,
+				const unsigned char *writearr,
+				unsigned char *readarr)
+{
+	unsigned int i;
+	if (writecnt > 16 || readcnt > 16 || writecnt == 0) {
+		msg_perr("Error: Invalid read/write count for send command.\n");
+		return SPI_GENERIC_ERROR;
+	}
+
+	int fd = get_fd_from_context(flash);
+	if (fd < 0)
+		return SPI_GENERIC_ERROR;
+
+	int ret = lspcon_i2c_spi_disable_all_protection(fd);
+	ret |= lspcon_i2c_spi_enable_write_status_register(fd);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 1);
+
+	/* First byte of writearr shuld be the command value, followed by the value to write.
+	   Read length occupies 4 bit and represents 16 level, thus if read 1 byte,
+           read length should be set 0. */
+	packet_t packet = {
+		writearr[0], &writearr[1], (writecnt - 1) | ((readcnt - 1) << 4),
+		SWSPICTL_ACCESS_TRIGGER | (readcnt ? 0 : SWSPICTL_NO_READ),
+	};
+
+	ret |= lspcon_i2c_spi_register_control(fd, &packet);
+	ret |= lspcon_i2c_spi_wait_command_done(fd, SWSPICTL, SWSPICTL_ACCESS_TRIGGER);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 0);
+	if (ret)
+		return ret;
+
+	for (i = 0; i < readcnt; ++i) {
+		ret |= lspcon_i2c_spi_read_register(fd, SWSPI_RDATA, &readarr[i]);
+	}
+
+	ret |= lspcon_i2c_spi_wait_rom_free(fd);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_enable_hw_write(int fd)
+{
+	int ret = 0;
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, PAGE_HW_COFIG_REGISTER);
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, PAGE_HW_WRITE_ENABLE);
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, 0x50);
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, 0x41);
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, 0x52);
+	ret |= lspcon_i2c_spi_write_register(fd, PAGE_HW_WRITE, 0x44);
+
+	return ret;
+}
+
+static int lspcon_i2c_clt2_spi_reset(int fd)
+{
+	int ret = 0;
+	ret |= lspcon_i2c_spi_write_register(fd, CLT2_SPI, 0x20);
+	struct timespec wait_100ms = { 0, (unsigned)1e8 };
+	nanosleep(&wait_100ms, NULL);
+	ret |= lspcon_i2c_spi_write_register(fd, CLT2_SPI, 0x00);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_reset_mpu_stop(int fd)
+{
+	int ret = 0;
+	ret |= lspcon_i2c_spi_write_register(fd, MPU, 0xc0); // cmd mode
+	ret |= lspcon_i2c_spi_write_register(fd, MPU, 0x40); // stop mcu
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_map_page(int fd, unsigned int offset)
+{
+	int ret = 0;
+	/* Page number byte, need to / PAGE_SIZE. */
+	ret |= lspcon_i2c_spi_write_register(fd, ROMADDR_BYTE1, (offset >> 8) & 0xff);
+	ret |= lspcon_i2c_spi_write_register(fd, ROMADDR_BYTE2, (offset >> 16));
+
+	return ret ? SPI_GENERIC_ERROR : 0;
+}
+
+static int lspcon_i2c_spi_read(struct flashctx *flash, uint8_t *buf,
+			unsigned int start, unsigned int len)
+{
+	unsigned int i;
+	int ret = 0;
+	if (start & 0xff)
+		return default_spi_read(flash, buf, start, len);
+
+	int fd = get_fd_from_context(flash);
+	if (fd < 0)
+		return SPI_GENERIC_ERROR;
+
+	for (i = 0; i < len; i += PAGE_SIZE) {
+		ret |= lspcon_i2c_spi_map_page(fd, start + i);
+		ret |= lspcon_i2c_spi_read_data(fd, PAGE_ADDRESS, buf + i, min(len - i, PAGE_SIZE));
+	}
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_write_page(int fd, const uint8_t *buf, unsigned int len)
+{
+	/**
+         * Using static buffer with maximum possible size,
+         * extra byte is needed for prefixing zero at index 0.
+         */
+	uint8_t write_buffer[PAGE_SIZE + 1] = { 0 };
+	if (len > PAGE_SIZE)
+		return SPI_GENERIC_ERROR;
+
+	/* First byte represents the writing offset and should always be zero. */
+	memcpy(&write_buffer[1], buf, len);
+
+	return lspcon_i2c_spi_write_data(fd, PAGE_ADDRESS, write_buffer, len + 1);
+}
+
+static int lspcon_i2c_spi_write_256(struct flashctx *flash, const uint8_t *buf,
+				unsigned int start, unsigned int len)
+{
+	int ret = 0;
+	if (start & 0xff)
+		return default_spi_write_256(flash, buf, start, len);
+
+	int fd = get_fd_from_context(flash);
+	if (fd < 0)
+		return SPI_GENERIC_ERROR;
+
+	ret |= lspcon_i2c_spi_disable_all_protection(fd);
+	/* Enable hardware write and reset clt2SPI interface. */
+	ret |= lspcon_i2c_spi_enable_hw_write(fd);
+	ret |= lspcon_i2c_clt2_spi_reset(fd);
+
+	for (unsigned int i = 0; i < len; i += PAGE_SIZE) {
+		ret |= lspcon_i2c_spi_map_page(fd, start + i);
+		ret |= lspcon_i2c_spi_write_page(fd, buf + i, min(len - i, PAGE_SIZE));
+	}
+
+	ret |= lspcon_i2c_spi_enable_write_protection(fd);
+	ret |= lspcon_i2c_spi_disable_hw_write(fd);
+
+	return ret;
+}
+
+static int lspcon_i2c_spi_write_aai(struct flashctx *flash, const uint8_t *buf,
+				 unsigned int start, unsigned int len)
+{
+	msg_perr("Error: AAI write function is not supported.\n");
+	return SPI_GENERIC_ERROR;
+}
+
+static const struct spi_master spi_master_i2c_lspcon = {
+	.max_data_read = 16,
+	.max_data_write = 12,
+	.command = lspcon_i2c_spi_send_command,
+	.multicommand = default_spi_send_multicommand,
+	.read = lspcon_i2c_spi_read,
+	.write_256 = lspcon_i2c_spi_write_256,
+	.write_aai = lspcon_i2c_spi_write_aai,
+};
+
+/* TODO: MPU still stopped at this point, probably need to reset it. */
+static int lspcon_i2c_spi_shutdown(void *data)
+{
+	int ret = 0;
+        struct lspcon_i2c_spi_data *lspcon_data =
+		(struct lspcon_i2c_spi_data *)data;
+	int fd = lspcon_data->fd;
+	ret |= lspcon_i2c_spi_enable_write_protection(fd);
+	ret |= lspcon_i2c_spi_toggle_register_protection(fd, 0);
+	i2c_close(fd);
+	free(data);
+
+	return ret;
+}
+
+/* TODO: remove this out of the specific SPI master implementation. */
+static int get_bus(void)
+{
+	char *bus_str = extract_programmer_param("bus");
+        int ret = SPI_GENERIC_ERROR;
+	if (bus_str) {
+		char *bus_suffix;
+		errno = 0;
+		int bus = (int)strtol(bus_str, &bus_suffix, 10);
+		if (errno != 0 || bus_str == bus_suffix) {
+			msg_perr("Error: Could not convert 'bus'.\n");
+			goto get_bus_done;
+		}
+
+		if (bus < 0 || bus > 255) {
+			msg_perr("Error: Value for 'bus' is out of range(0-255).\n");
+			goto get_bus_done;
+		}
+
+		if (strlen(bus_suffix) > 0) {
+			msg_perr("Error: Garbage following 'bus' value.\n");
+			goto get_bus_done;
+		}
+
+		msg_pinfo("Using i2c bus %i.\n", bus);
+		ret = bus;
+		goto get_bus_done;
+	} else {
+		msg_perr("Error: Bus number not specified.\n");
+	}
+get_bus_done:
+	if (bus_str)
+		free(bus_str);
+
+	return ret;
+}
+
+static int register_lspcon_i2c_spi_master(void *ptr)
+{
+	struct spi_master mst = spi_master_i2c_lspcon;
+	mst.data = ptr;
+
+	return register_spi_master(&mst);
+}
+
+int lspcon_i2c_spi_init(void)
+{
+	int lspcon_i2c_spi_bus = get_bus();
+	if (lspcon_i2c_spi_bus < 0)
+		return SPI_GENERIC_ERROR;
+
+	int ret = 0;
+	int fd = i2c_open(lspcon_i2c_spi_bus, REGISTER_ADDRESS, 0);
+	if (fd < 0)
+		return fd;
+
+	ret |= lspcon_i2c_spi_reset_mpu_stop(fd);
+	if (ret)
+		return ret;
+
+	struct lspcon_i2c_spi_data *data = calloc(1, sizeof(struct lspcon_i2c_spi_data));
+	if (!data) {
+		msg_perr("Unable to allocate space for extra SPI master data.\n");
+		return SPI_GENERIC_ERROR;
+	}
+
+	data->fd = fd;
+	ret |= register_shutdown(lspcon_i2c_spi_shutdown, data);
+	ret |= register_lspcon_i2c_spi_master(data);
+
+	return ret;
+}
diff --git a/meson.build b/meson.build
index b847c63b..699370a6 100644
--- a/meson.build
+++ b/meson.build
@@ -63,6 +63,7 @@ config_satasii = get_option('config_satasii')
 config_serprog = get_option('config_serprog')
 config_usbblaster_spi = get_option('config_usbblaster_spi')
 config_stlinkv3_spi = get_option('config_stlinkv3_spi')
+config_lspcon_i2c_spi = get_option('config_lspcon_i2c_spi')
 
 cargs = []
 deps = []
@@ -283,6 +284,10 @@ if config_stlinkv3_spi
   srcs += 'stlinkv3_spi.c'
   cargs += '-DCONFIG_STLINKV3_SPI=1'
 endif
+if config_lspcon_i2c_spi
+  srcs += 'lspcon_i2c_spi.c'
+  cargs += '-DCONFIG_LSPCON_I2C_SPI=1'
+endif
 
 # bitbanging SPI infrastructure
 if config_bitbang_spi
diff --git a/meson_options.txt b/meson_options.txt
index 28312716..a103dc60 100644
--- a/meson_options.txt
+++ b/meson_options.txt
@@ -35,3 +35,4 @@ option('config_satasii', type : 'boolean', value : true, description : 'SiI SATA
 option('config_serprog', type : 'boolean', value : true, description : 'serprog')
 option('config_usbblaster_spi', type : 'boolean', value : true, description : 'Altera USB-Blaster dongles')
 option('config_stlinkv3_spi', type : 'boolean', value : true, description : 'STMicroelectronics STLINK-V3')
+option('config_lspcon_i2c_spi', type : 'boolean', value : false, description : 'Parade lspcon USB-C to HDMI protocol translator')
diff --git a/programmer.h b/programmer.h
index 9a41be10..f6c53996 100644
--- a/programmer.h
+++ b/programmer.h
@@ -129,6 +129,9 @@ enum programmer {
 #endif
 #if CONFIG_STLINKV3_SPI == 1
 	PROGRAMMER_STLINKV3_SPI,
+#endif
+#if CONFIG_LSPCON_I2C_SPI == 1
+	PROGRAMMER_LSPCON_I2C_SPI,
 #endif
 	PROGRAMMER_INVALID /* This must always be the last entry. */
 };
@@ -811,4 +814,9 @@ struct libusb_device_handle *usb_dev_get_by_vid_pid_serial(
 struct libusb_device_handle *usb_dev_get_by_vid_pid_number(
 		struct libusb_context *usb_ctx, uint16_t vid, uint16_t pid, unsigned int num);
 
+/* lspcon_i2c_spi.c */
+#if CONFIG_LSPCON_I2C_SPI == 1
+int lspcon_i2c_spi_init(void);
+#endif
+
 #endif				/* !__PROGRAMMER_H__ */
-- 
cgit v1.2.3