mirror of
https://github.com/CTCaer/hekate.git
synced 2024-10-03 13:12:05 +00:00
185526d134
BDK will allow developers to use the full collection of drivers, with limited editing, if any, for making payloads for Nintendo Switch. Using a single source for everything will also help decoupling Switch specific code and easily port it to other Tegra X1/X1+ platforms. And maybe even to lower targets. Everything is now centrilized into bdk folder. Every module or project can utilize it by simply including it. This is just the start and it will continue to improve.
422 lines
10 KiB
C
422 lines
10 KiB
C
/*
|
|
* Touch driver for Nintendo Switch's STM FingerTip S (4CD60D) touch controller
|
|
*
|
|
* Copyright (c) 2018 langerhans
|
|
* Copyright (c) 2018-2020 CTCaer
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope 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 <string.h>
|
|
|
|
#include "../soc/clock.h"
|
|
#include "../soc/i2c.h"
|
|
#include "../soc/pinmux.h"
|
|
#include "../power/max7762x.h"
|
|
#include "../power/max77620.h"
|
|
#include "../soc/gpio.h"
|
|
#include "../soc/t210.h"
|
|
#include "../utils/btn.h"
|
|
#include "../utils/util.h"
|
|
#include "touch.h"
|
|
|
|
|
|
#include "../gfx/gfx.h"
|
|
#define DPRINTF(...) gfx_printf(__VA_ARGS__)
|
|
|
|
static int touch_command(u8 cmd, u8 *buf, u8 size)
|
|
{
|
|
int res = i2c_send_buf_small(I2C_3, STMFTS_I2C_ADDR, cmd, buf, size);
|
|
if (!res)
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
static int touch_read_reg(u8 *cmd, u32 csize, u8 *buf, u32 size)
|
|
{
|
|
int res = i2c_send_buf_small(I2C_3, STMFTS_I2C_ADDR, cmd[0], &cmd[1], csize - 1);
|
|
if (res)
|
|
res = i2c_recv_buf(buf, size, I2C_3, STMFTS_I2C_ADDR);
|
|
if (!res)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int touch_wait_event(u8 event, u8 status, u32 timeout)
|
|
{
|
|
u32 timer = get_tmr_ms() + timeout;
|
|
while (true)
|
|
{
|
|
u8 tmp[8] = {0};
|
|
i2c_recv_buf_small(tmp, 8, I2C_3, STMFTS_I2C_ADDR, STMFTS_READ_ONE_EVENT);
|
|
if (tmp[1] == event && tmp[2] == status)
|
|
return 0;
|
|
|
|
if (get_tmr_ms() > timer)
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
#define X_REAL_MAX 1264
|
|
#define Y_REAL_MAX 704
|
|
#define EDGE_OFFSET 15
|
|
|
|
static void _touch_compensate_limits(touch_event *event, bool touching)
|
|
{
|
|
event->x = MAX(event->x, EDGE_OFFSET);
|
|
event->x = MIN(event->x, X_REAL_MAX);
|
|
event->x -= EDGE_OFFSET;
|
|
u32 x_adj = (1280 * 1000) / (X_REAL_MAX - EDGE_OFFSET);
|
|
event->x = ((u32)event->x * x_adj) / 1000;
|
|
|
|
if (touching)
|
|
{
|
|
event->y = MAX(event->y, EDGE_OFFSET);
|
|
event->y = MIN(event->y, Y_REAL_MAX);
|
|
event->y -= EDGE_OFFSET;
|
|
u32 y_adj = (720 * 1000) / (Y_REAL_MAX - EDGE_OFFSET);
|
|
event->y = ((u32)event->y * y_adj) / 1000;
|
|
}
|
|
}
|
|
|
|
static void _touch_process_contact_event(touch_event *event, bool touching)
|
|
{
|
|
event->x = (event->raw[2] << 4) | ((event->raw[4] & STMFTS_MASK_Y_LSB) >> 4);
|
|
|
|
// Normally, GUI elements have bigger horizontal estate.
|
|
// Avoid parsing y axis when finger is removed to minimize touch noise.
|
|
if (touching)
|
|
{
|
|
event->y = (event->raw[3] << 4) | (event->raw[4] & STMFTS_MASK_X_MSB);
|
|
|
|
event->z = event->raw[5] | (event->raw[6] << 8);
|
|
event->z = event->z << 6;
|
|
u16 tmp = 0x40;
|
|
if ((event->raw[7] & 0x3F) != 1 && (event->raw[7] & 0x3F) != 0x3F)
|
|
tmp = event->raw[7] & 0x3F;
|
|
event->z /= tmp + 0x40;
|
|
|
|
event->fingers = ((event->raw[1] & STMFTS_MASK_TOUCH_ID) >> 4) + 1;
|
|
}
|
|
else
|
|
event->fingers = 0;
|
|
|
|
_touch_compensate_limits(event, touching);
|
|
}
|
|
|
|
static void _touch_parse_event(touch_event *event)
|
|
{
|
|
event->type = event->raw[1] & STMFTS_MASK_EVENT_ID;
|
|
|
|
switch (event->type)
|
|
{
|
|
case STMFTS_EV_MULTI_TOUCH_ENTER:
|
|
case STMFTS_EV_MULTI_TOUCH_MOTION:
|
|
_touch_process_contact_event(event, true);
|
|
if (event->z < 255) // Reject palm rest.
|
|
event->touch = true;
|
|
else
|
|
{
|
|
event->touch = false;
|
|
event->type = STMFTS_EV_MULTI_TOUCH_LEAVE;
|
|
}
|
|
break;
|
|
case STMFTS_EV_MULTI_TOUCH_LEAVE:
|
|
event->touch = false;
|
|
_touch_process_contact_event(event, false);
|
|
break;
|
|
case STMFTS_EV_NO_EVENT:
|
|
if (event->touch)
|
|
event->type = STMFTS_EV_MULTI_TOUCH_MOTION;
|
|
break;
|
|
default:
|
|
if (event->touch && event->raw[0] == STMFTS_EV_MULTI_TOUCH_MOTION)
|
|
event->type = STMFTS_EV_MULTI_TOUCH_MOTION;
|
|
else
|
|
event->type = STMFTS_EV_MULTI_TOUCH_LEAVE;
|
|
}
|
|
|
|
// gfx_con_setpos(&gfx_con, 0, 300);
|
|
// DPRINTF("x = %d \ny = %d \nz = %d \n", event->x, event->y, event->z);
|
|
// DPRINTF("0 = %02X\n1 = %02x\n2 = %02x\n3 = %02x\n", event->raw[0], event->raw[1], event->raw[2], event->raw[3]);
|
|
// DPRINTF("4 = %02X\n5 = %02x\n6 = %02x\n7 = %02x\n", event->raw[4], event->raw[5], event->raw[6], event->raw[7]);
|
|
}
|
|
|
|
void touch_poll(touch_event *event)
|
|
{
|
|
i2c_recv_buf_small(event->raw, 8, I2C_3, STMFTS_I2C_ADDR, STMFTS_LATEST_EVENT);
|
|
|
|
_touch_parse_event(event);
|
|
}
|
|
|
|
touch_event touch_poll_wait()
|
|
{
|
|
touch_event event;
|
|
do
|
|
{
|
|
touch_poll(&event);
|
|
} while (event.type != STMFTS_EV_MULTI_TOUCH_LEAVE);
|
|
|
|
return event;
|
|
}
|
|
|
|
touch_info touch_get_info()
|
|
{
|
|
touch_info info;
|
|
u8 buf[8];
|
|
memset(&buf, 0, 8);
|
|
i2c_recv_buf_small(buf, 8, I2C_3, STMFTS_I2C_ADDR, STMFTS_READ_INFO);
|
|
|
|
info.chip_id = buf[0] << 8 | buf[1];
|
|
info.fw_ver = buf[2] << 8 | buf[3];
|
|
info.config_id = buf[4];
|
|
info.config_ver = buf[5];
|
|
|
|
//DPRINTF("ID: %04X, FW Ver: %d.%02d\nCfg ID: %02x, Cfg Ver: %d\n",
|
|
// info.chip_id, info.fw_ver >> 8, info.fw_ver & 0xFF, info.config_id, info.config_ver);
|
|
|
|
return info;
|
|
}
|
|
|
|
int touch_get_fw_info(touch_fw_info_t *fw)
|
|
{
|
|
u8 buf[8] = {0};
|
|
|
|
// Get fw address info.
|
|
u8 cmd[3] = { STMFTS_RW_FRAMEBUFFER_REG, 0, 0x60 };
|
|
int res = touch_read_reg(cmd, 3, buf, 3);
|
|
if (!res)
|
|
{
|
|
// Get fw info.
|
|
cmd[1] = buf[2]; cmd[2] = buf[1];
|
|
res = touch_read_reg(cmd, 3, buf, 8);
|
|
if (!res)
|
|
{
|
|
fw->fw_id = (buf[1] << 24) | (buf[2] << 16) | (buf[3] << 8) | buf[4];
|
|
fw->ftb_ver = (buf[6] << 8) | buf[5];
|
|
}
|
|
|
|
cmd[2]++;
|
|
res = touch_read_reg(cmd, 3, buf, 8);
|
|
if (!res)
|
|
fw->fw_rev = (buf[7] << 8) | buf[6];
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
int touch_sys_reset()
|
|
{
|
|
u8 cmd[3] = { 0, 0x28, 0x80 }; // System reset cmd.
|
|
for (u8 retries = 0; retries < 3; retries++)
|
|
{
|
|
if (touch_command(STMFTS_WRITE_REG, cmd, 3))
|
|
{
|
|
msleep(10);
|
|
continue;
|
|
}
|
|
msleep(10);
|
|
if (touch_wait_event(STMFTS_EV_CONTROLLER_READY, 0, 20))
|
|
continue;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
int touch_panel_ito_test(u8 *err)
|
|
{
|
|
int res = 0;
|
|
|
|
// Reset touchscreen module.
|
|
if (touch_sys_reset())
|
|
return res;
|
|
|
|
// Do ITO Production test.
|
|
u8 cmd[2] = { 1, 0 };
|
|
if (touch_command(STMFTS_ITO_CHECK, cmd, 2))
|
|
return res;
|
|
|
|
u32 timer = get_tmr_ms() + 2000;
|
|
while (true)
|
|
{
|
|
u8 tmp[8] = {0};
|
|
i2c_recv_buf_small(tmp, 8, I2C_3, STMFTS_I2C_ADDR, STMFTS_READ_ONE_EVENT);
|
|
if (tmp[1] == 0xF && tmp[2] == 0x5)
|
|
{
|
|
if (err)
|
|
{
|
|
err[0] = tmp[3];
|
|
err[1] = tmp[4];
|
|
}
|
|
|
|
res = 1;
|
|
break;
|
|
}
|
|
|
|
if (get_tmr_ms() > timer)
|
|
break;
|
|
}
|
|
|
|
// Reset touchscreen module.
|
|
touch_sys_reset();
|
|
|
|
return res;
|
|
}
|
|
|
|
int touch_get_fb_info(u8 *buf)
|
|
{
|
|
u8 tmp[5];
|
|
|
|
u8 cmd[3] = { STMFTS_RW_FRAMEBUFFER_REG, 0, 0 };
|
|
int res = 0;
|
|
|
|
|
|
for (u32 i = 0; i < 0x10000; i+=4)
|
|
{
|
|
if (!res)
|
|
{
|
|
cmd[1] = (i >> 8) & 0xFF;
|
|
cmd[2] = i & 0xFF;
|
|
memset(tmp, 0xCC, 5);
|
|
res = touch_read_reg(cmd, 3, tmp, 5);
|
|
memcpy(&buf[i], tmp + 1, 4);
|
|
}
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
int touch_sense_enable()
|
|
{
|
|
// Enable auto tuning calibration and multi-touch sensing.
|
|
u8 cmd = 1;
|
|
if (touch_command(STMFTS_AUTO_CALIBRATION, &cmd, 1))
|
|
return 0;
|
|
|
|
if (touch_command(STMFTS_MS_MT_SENSE_ON, NULL, 0))
|
|
return 0;
|
|
|
|
if (touch_command(STMFTS_CLEAR_EVENT_STACK, NULL, 0))
|
|
return 0;
|
|
|
|
return 1;
|
|
}
|
|
|
|
int touch_execute_autotune()
|
|
{
|
|
// Reset touchscreen module.
|
|
if (touch_sys_reset())
|
|
return 0;
|
|
|
|
// Trim low power oscillator.
|
|
if (touch_command(STMFTS_LP_TIMER_CALIB, NULL, 0))
|
|
return 0;
|
|
msleep(200);
|
|
|
|
// Apply Mutual Sense Compensation tuning.
|
|
if (touch_command(STMFTS_MS_CX_TUNING, NULL, 0))
|
|
return 0;
|
|
if (touch_wait_event(STMFTS_EV_STATUS, STMFTS_EV_STATUS_MS_CX_TUNING_DONE, 2000))
|
|
return 0;
|
|
|
|
// Apply Self Sense Compensation tuning.
|
|
if (touch_command(STMFTS_SS_CX_TUNING, NULL, 0))
|
|
return 0;
|
|
if (touch_wait_event(STMFTS_EV_STATUS, STMFTS_EV_STATUS_SS_CX_TUNING_DONE, 2000))
|
|
return 0;
|
|
|
|
// Save Compensation data to EEPROM.
|
|
if (touch_command(STMFTS_SAVE_CX_TUNING, NULL, 0))
|
|
return 0;
|
|
if (touch_wait_event(STMFTS_EV_STATUS, STMFTS_EV_STATUS_WRITE_CX_TUNE_DONE, 2000))
|
|
return 0;
|
|
|
|
return touch_sense_enable();
|
|
}
|
|
|
|
static int touch_init()
|
|
{
|
|
// Initialize touchscreen module.
|
|
if (touch_sys_reset())
|
|
return 0;
|
|
|
|
return touch_sense_enable();
|
|
}
|
|
|
|
int touch_power_on()
|
|
{
|
|
// Enables LDO6 for touchscreen VDD/AVDD supply
|
|
max77620_regulator_set_volt_and_flags(REGULATOR_LDO6, 2900000, MAX77620_POWER_MODE_NORMAL);
|
|
i2c_send_byte(I2C_5, MAX77620_I2C_ADDR, MAX77620_REG_LDO6_CFG2,
|
|
MAX77620_LDO_CFG2_ADE_ENABLE | (3 << 3) | (MAX77620_POWER_MODE_NORMAL << MAX77620_LDO_POWER_MODE_SHIFT));
|
|
|
|
// Configure touchscreen GPIO.
|
|
PINMUX_AUX(PINMUX_AUX_DAP4_SCLK) = PINMUX_PULL_DOWN | 1;
|
|
gpio_config(GPIO_PORT_J, GPIO_PIN_7, GPIO_MODE_GPIO);
|
|
gpio_output_enable(GPIO_PORT_J, GPIO_PIN_7, GPIO_OUTPUT_ENABLE);
|
|
gpio_write(GPIO_PORT_J, GPIO_PIN_7, GPIO_HIGH);
|
|
|
|
// IRQ and more.
|
|
// PINMUX_AUX(PINMUX_AUX_TOUCH_INT) = PINMUX_INPUT_ENABLE | PINMUX_TRISTATE | PINMUX_PULL_UP | 3;
|
|
// gpio_config(GPIO_PORT_X, GPIO_PIN_1, GPIO_MODE_GPIO);
|
|
// gpio_write(GPIO_PORT_X, GPIO_PIN_1, GPIO_LOW);
|
|
|
|
// Configure Touscreen and GCAsic shared GPIO.
|
|
PINMUX_AUX(PINMUX_AUX_CAM_I2C_SDA) = PINMUX_LPDR | PINMUX_INPUT_ENABLE | PINMUX_TRISTATE | PINMUX_PULL_UP | 2;
|
|
PINMUX_AUX(PINMUX_AUX_CAM_I2C_SCL) = PINMUX_IO_HV | PINMUX_LPDR | PINMUX_TRISTATE | PINMUX_PULL_DOWN | 2;
|
|
gpio_config(GPIO_PORT_S, GPIO_PIN_3, GPIO_MODE_GPIO);
|
|
|
|
// Initialize I2C3.
|
|
pinmux_config_i2c(I2C_3);
|
|
clock_enable_i2c(I2C_3);
|
|
i2c_init(I2C_3);
|
|
|
|
// Wait for the touchscreen module to get ready.
|
|
touch_wait_event(STMFTS_EV_CONTROLLER_READY, 0, 20);
|
|
|
|
// Check for forced boot time calibration.
|
|
if (btn_read_vol() == (BTN_VOL_UP | BTN_VOL_DOWN))
|
|
{
|
|
u8 err[2];
|
|
if (touch_panel_ito_test(err))
|
|
if (!err[0] && !err[1])
|
|
return touch_execute_autotune();
|
|
}
|
|
|
|
// Initialize touchscreen.
|
|
u32 retries = 3;
|
|
while (retries)
|
|
{
|
|
if (touch_init())
|
|
return 1;
|
|
retries--;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void touch_power_off()
|
|
{
|
|
// Disable touchscreen power.
|
|
gpio_write(GPIO_PORT_J, GPIO_PIN_7, GPIO_LOW);
|
|
|
|
// Disables LDO6 for touchscreen VDD, AVDD supply
|
|
max77620_regulator_enable(REGULATOR_LDO6, 0);
|
|
i2c_send_byte(I2C_5, MAX77620_I2C_ADDR, MAX77620_REG_LDO6_CFG2,
|
|
MAX77620_LDO_CFG2_ADE_ENABLE | (2 << 3) | (MAX77620_POWER_MODE_NORMAL << MAX77620_LDO_POWER_MODE_SHIFT));
|
|
|
|
clock_disable_i2c(I2C_3);
|
|
} |