update: added support for IMU and Lottie JSON
This commit is contained in:
323
components/SensorLib/src/touch/TouchClassCST226.cpp
Normal file
323
components/SensorLib/src/touch/TouchClassCST226.cpp
Normal file
@@ -0,0 +1,323 @@
|
||||
/**
|
||||
*
|
||||
* @license MIT License
|
||||
*
|
||||
* Copyright (c) 2023 lewis he
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
* of this software and associated documentation files (the "Software"), to deal
|
||||
* in the Software without restriction, including without limitation the rights
|
||||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
* copies of the Software, and to permit persons to whom the Software is
|
||||
* furnished to do so, subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in all
|
||||
* copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||
* SOFTWARE.
|
||||
*
|
||||
* @file TouchClassCST226.cpp
|
||||
* @author Lewis He (lewishe@outlook.com)
|
||||
* @date 2023-10-06
|
||||
*/
|
||||
#include "TouchClassCST226.h"
|
||||
|
||||
#define CST2xx_REG_STATUS (0x00)
|
||||
#define CST226SE_BUFFER_NUM (28)
|
||||
|
||||
#if defined(ARDUINO)
|
||||
TouchClassCST226::TouchClassCST226()
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
bool TouchClassCST226::begin(PLATFORM_WIRE_TYPE &wire, uint8_t address, int sda, int scl)
|
||||
{
|
||||
return SensorCommon::begin(wire, address, sda, scl);
|
||||
}
|
||||
|
||||
#elif defined(ESP_PLATFORM)
|
||||
|
||||
#if ((ESP_IDF_VERSION >= ESP_IDF_VERSION_VAL(5,0,0)) && defined(CONFIG_SENSORLIB_ESP_IDF_NEW_API))
|
||||
bool TouchClassCST226::begin(i2c_master_bus_handle_t i2c_dev_bus_handle, uint8_t addr)
|
||||
{
|
||||
return SensorCommon::begin(i2c_dev_bus_handle, addr);
|
||||
}
|
||||
#else
|
||||
bool TouchClassCST226::begin(i2c_port_t port_num, uint8_t addr, int sda, int scl)
|
||||
{
|
||||
return SensorCommon::begin(port_num, addr, sda, scl);
|
||||
}
|
||||
#endif //ESP_IDF_VERSION
|
||||
|
||||
#endif //ARDUINO
|
||||
|
||||
|
||||
bool TouchClassCST226::begin(uint8_t addr, iic_fptr_t readRegCallback, iic_fptr_t writeRegCallback)
|
||||
{
|
||||
return SensorCommon::begin(addr, readRegCallback, writeRegCallback);
|
||||
}
|
||||
|
||||
void TouchClassCST226::reset()
|
||||
{
|
||||
if (__rst != SENSOR_PIN_NONE) {
|
||||
this->setGpioMode(__rst, OUTPUT);
|
||||
this->setGpioLevel(__rst, LOW);
|
||||
delay(100);
|
||||
this->setGpioLevel(__rst, HIGH);
|
||||
delay(100);
|
||||
} else {
|
||||
writeRegister(0xD1, 0x0E);
|
||||
delay(20);
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t TouchClassCST226::getPoint(int16_t *x_array, int16_t *y_array, uint8_t get_point)
|
||||
{
|
||||
uint8_t buffer[CST226SE_BUFFER_NUM];
|
||||
uint8_t index = 0;
|
||||
|
||||
if (readRegister(CST2xx_REG_STATUS, buffer, CST226SE_BUFFER_NUM) == DEV_WIRE_ERR) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef LOG_PORT
|
||||
LOG_PORT.print("RAW:");
|
||||
for (int i = 0; i < CST226SE_BUFFER_NUM; ++i) {
|
||||
LOG_PORT.printf("%02X,", buffer[i]);
|
||||
}
|
||||
LOG_PORT.println();
|
||||
#endif
|
||||
|
||||
if (buffer[0] == 0x83 && buffer[1] == 0x17 && buffer[5] == 0x80) {
|
||||
if (__homeButtonCb) {
|
||||
__homeButtonCb(__userData);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (buffer[6] != 0xAB)return 0;
|
||||
if (buffer[0] == 0xAB)return 0;
|
||||
if (buffer[5] == 0x80)return 0;
|
||||
|
||||
uint8_t point = buffer[5] & 0x7F;
|
||||
if (point > 5 || !point) {
|
||||
writeRegister(0x00, 0xAB);
|
||||
return 0;
|
||||
}
|
||||
|
||||
for (int i = 0; i < point; i++) {
|
||||
report.id[i] = buffer[index] >> 4;
|
||||
report.status[i] = buffer[index] & 0x0F;
|
||||
report.x[i] = (uint16_t)((buffer[index + 1] << 4) | ((buffer[index + 3] >> 4) & 0x0F));
|
||||
report.y[i] = (uint16_t)((buffer[index + 2] << 4) | (buffer[index + 3] & 0x0F));
|
||||
report.pressure[i] = buffer[index + 4];
|
||||
index = (i == 0) ? (index + 7) : (index + 5);
|
||||
}
|
||||
|
||||
updateXY(point, report.x, report.y);
|
||||
|
||||
#ifdef LOG_PORT
|
||||
for (int i = 0; i < point; i++) {
|
||||
LOG_PORT.printf("[%d]-X:%u Y:%u P:%u sta:%u ", report.id[i], report.x[i], report.y[i], report.pressure[i], report.status[i]);
|
||||
}
|
||||
LOG_PORT.println();
|
||||
#endif
|
||||
|
||||
if (point) {
|
||||
for (int i = 0; i < get_point; i++) {
|
||||
x_array[i] = report.x[i];
|
||||
y_array[i] = report.y[i];
|
||||
}
|
||||
}
|
||||
|
||||
return point;
|
||||
}
|
||||
|
||||
bool TouchClassCST226::isPressed()
|
||||
{
|
||||
static uint32_t lastPulse = 0;
|
||||
if (__irq != SENSOR_PIN_NONE) {
|
||||
int val = this->getGpioLevel(__irq) == LOW;
|
||||
if (val) {
|
||||
//Filter low levels with intervals greater than 1000ms
|
||||
val = (millis() - lastPulse > 1000) ? false : true;
|
||||
lastPulse = millis();
|
||||
return val;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
return getPoint(NULL, NULL, 1);
|
||||
}
|
||||
|
||||
|
||||
const char *TouchClassCST226::getModelName()
|
||||
{
|
||||
return "CST226SE";
|
||||
}
|
||||
|
||||
void TouchClassCST226::sleep()
|
||||
{
|
||||
writeRegister(0xD1, 0x05);
|
||||
#ifdef ESP32
|
||||
if (__irq != SENSOR_PIN_NONE) {
|
||||
this->setGpioMode(__irq, OPEN_DRAIN);
|
||||
}
|
||||
if (__rst != SENSOR_PIN_NONE) {
|
||||
this->setGpioMode(__rst, OPEN_DRAIN);
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
void TouchClassCST226::wakeup()
|
||||
{
|
||||
reset();
|
||||
}
|
||||
|
||||
void TouchClassCST226::idle()
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
uint8_t TouchClassCST226::getSupportTouchPoint()
|
||||
{
|
||||
return 5;
|
||||
}
|
||||
|
||||
bool TouchClassCST226::getResolution(int16_t *x, int16_t *y)
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
void TouchClassCST226::setHomeButtonCallback(home_button_callback_t cb, void *user_data)
|
||||
{
|
||||
__homeButtonCb = cb;
|
||||
__userData = user_data;
|
||||
}
|
||||
|
||||
void TouchClassCST226::setGpioCallback(gpio_mode_fptr_t mode_cb,
|
||||
gpio_write_fptr_t write_cb,
|
||||
gpio_read_fptr_t read_cb)
|
||||
{
|
||||
SensorCommon::setGpioModeCallback(mode_cb);
|
||||
SensorCommon::setGpioWriteCallback(write_cb);
|
||||
SensorCommon::setGpioReadCallback(read_cb);
|
||||
}
|
||||
|
||||
bool TouchClassCST226::initImpl()
|
||||
{
|
||||
|
||||
if (__rst != SENSOR_PIN_NONE) {
|
||||
this->setGpioMode(__rst, OUTPUT);
|
||||
}
|
||||
|
||||
if (__irq != SENSOR_PIN_NONE) {
|
||||
this->setGpioMode(__irq, INPUT);
|
||||
}
|
||||
|
||||
reset();
|
||||
|
||||
uint8_t buffer[8];
|
||||
// Enter Command mode
|
||||
writeRegister(0xD1, 0x01);
|
||||
delay(10);
|
||||
uint8_t write_buffer[2] = {0xD1, 0xFC};
|
||||
writeThenRead(write_buffer, 2, buffer, 4);
|
||||
uint32_t checkcode = 0;
|
||||
checkcode = buffer[3];
|
||||
checkcode <<= 8;
|
||||
checkcode |= buffer[2];
|
||||
checkcode <<= 8;
|
||||
checkcode |= buffer[1];
|
||||
checkcode <<= 8;
|
||||
checkcode |= buffer[0];
|
||||
|
||||
log_i("Chip checkcode:0x%lx.\r\n", checkcode);
|
||||
|
||||
write_buffer[0] = {0xD1};
|
||||
write_buffer[1] = {0xF8};
|
||||
writeThenRead(write_buffer, 2, buffer, 4);
|
||||
__resX = ( buffer[1] << 8) | buffer[0];
|
||||
__resY = ( buffer[3] << 8) | buffer[2];
|
||||
log_i("Chip resolution X:%u Y:%u\r\n", __resX, __resY);
|
||||
|
||||
write_buffer[0] = {0xD2};
|
||||
write_buffer[1] = {0x04};
|
||||
writeThenRead(write_buffer, 2, buffer, 4);
|
||||
uint32_t chipType = buffer[3];
|
||||
chipType <<= 8;
|
||||
chipType |= buffer[2];
|
||||
|
||||
|
||||
uint32_t ProjectID = buffer[1];
|
||||
ProjectID <<= 8;
|
||||
ProjectID |= buffer[0];
|
||||
log_i("Chip type :0x%lx, ProjectID:0X%lx\r\n",
|
||||
chipType, ProjectID);
|
||||
|
||||
|
||||
|
||||
write_buffer[0] = {0xD2};
|
||||
write_buffer[1] = {0x08};
|
||||
writeThenRead(write_buffer, 2, buffer, 8);
|
||||
|
||||
uint32_t fwVersion = buffer[3];
|
||||
fwVersion <<= 8;
|
||||
fwVersion |= buffer[2];
|
||||
fwVersion <<= 8;
|
||||
fwVersion |= buffer[1];
|
||||
fwVersion <<= 8;
|
||||
fwVersion |= buffer[0];
|
||||
|
||||
uint32_t checksum = buffer[7];
|
||||
checksum <<= 8;
|
||||
checksum |= buffer[6];
|
||||
checksum <<= 8;
|
||||
checksum |= buffer[5];
|
||||
checksum <<= 8;
|
||||
checksum |= buffer[4];
|
||||
|
||||
log_i("Chip ic version:0x%lx, checksum:0x%lx\n",
|
||||
fwVersion, checksum);
|
||||
|
||||
if (fwVersion == 0xA5A5A5A5) {
|
||||
log_i("Chip ic don't have firmware. \n");
|
||||
return false;
|
||||
}
|
||||
if ((checkcode & 0xffff0000) != 0xCACA0000) {
|
||||
log_i("Firmware info read error .\n");
|
||||
return false;
|
||||
}
|
||||
|
||||
__chipID = chipType;
|
||||
|
||||
// Exit Command mode
|
||||
writeRegister(0xD1, 0x09);
|
||||
return true;
|
||||
}
|
||||
|
||||
int TouchClassCST226::getReadMaskImpl()
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user