TouchDrvCST3530.cpp

Go to the documentation of this file.

 
#include "../SensorBuildOpt.h"
#if !SENSORLIB_EXCLUDE_TOUCH_CST3530
 
#include "TouchDrvCST3530.hpp"
 
uint16_t TouchDrvCST3530::check_sum_16(int val, uint8_t *buf, uint16_t len)
{
    uint16_t sum = val;
    while (len--) sum += *buf++;
    return sum;
}
 
const TouchPoints &TouchDrvCST3530::getTouchPoints()
{
    uint8_t numPoints = 0;
    uint8_t keyNumber = 0;
    uint8_t read_buffer[MAX_READ_BYTES] = {0};
 
    // Clear cached touch points
    _touchPoints.clear();
 
    // If read command fails, return zero points
    if (!writeCommand(READ_COMMAND, read_buffer, sizeof(read_buffer))) {
        writeCommand(CLEAR_COMMAND);
        return _touchPoints;
    }
    // If status is not 0xFF, clear points
    if (read_buffer[2] != 0xFF) {
        writeCommand(CLEAR_COMMAND);
        return _touchPoints;
    }
 
    numPoints = read_buffer[3] & 0x0F;  // Get number of touch points (lower 4 bits)
    keyNumber = (read_buffer[3] & 0xF0) >> 4; // Get key number (upper 4 bits)
 
    if (numPoints == 0 || numPoints > MAX_FINGER_NUM) {
        writeCommand(CLEAR_COMMAND);
        return _touchPoints;
    }
 
    for (uint8_t i = 0; i < numPoints; i++) {
        uint16_t idx = (keyNumber + i) * 5;
        if (idx + 8 >= MAX_READ_BYTES) {
            break;
        }
        const uint8_t pos_id  = read_buffer[idx + 8] & 0x0F;
        const uint8_t event   = read_buffer[idx + 8] >> 4;
        const uint16_t pos_x   = read_buffer[idx + 4] + ((uint16_t)(read_buffer[idx + 7] & 0x0F) << 8);
        const uint16_t pos_y   = read_buffer[idx + 5] + ((uint16_t)(read_buffer[idx + 7] & 0xF0) << 4);
        const uint8_t pressure  = read_buffer[idx + 6];
 
        if (check_sum_16(0x55, &read_buffer[4], (keyNumber + numPoints) * 5) != (read_buffer[0] | read_buffer[1] << 8)) {
            writeCommand(CLEAR_COMMAND);
            return _touchPoints;
        }
        if (event != 0x00) {
            _touchPoints.addPoint(pos_x, pos_y, pressure, pos_id, event);
        }
    }
    // Clear cached touch points
    writeCommand(CLEAR_COMMAND);
    // Swap XY or mirroring coordinates,if set
    updateXY(_touchPoints);
    return _touchPoints;
}
 
const char *TouchDrvCST3530::getModelName()
{
    return "CST3530";
}
 
void TouchDrvCST3530::sleep()
{
    writeCommand(0xD0000400);
    hal->delay(1);
    writeCommand(0xD0000400);
    writeCommand(SLEEP_COMMAND);
}
 
void TouchDrvCST3530::wakeup()
{
    reset();
    writeCommand(0xD0000400);
    hal->delay(1);
    writeCommand(0xD0000400);
    writeCommand(0xD0000000);
    writeCommand(0xD0000C00);
    writeCommand(0xD0000100);
}
 
bool TouchDrvCST3530::initImpl(uint8_t)
{
    int retry = 5;
    uint8_t buffer[50];
    while (retry--) {
        if (writeCommand(INFO_COMMAND, buffer, sizeof(buffer))) {
            if (buffer[2] == 0xCA && buffer[3] == 0xCA) {
                _maxTouchPoints = MAX_FINGER_NUM;
                _touchConfig.resolutionY = (buffer[31] << 8) | buffer[30];
                _touchConfig.resolutionX = (buffer[29] << 8) | buffer[28];
                _chipID = buffer[3] << 24 | buffer[2] << 16 | buffer[1] << 8 | buffer[0];
                SENSORLIB_LOG_D("Model:CST3530");
                SENSORLIB_LOG_D("RST Pin:%d", _pinsCfg.rstPin);
                SENSORLIB_LOG_D("IRQ Pin:%d", _pinsCfg.irqPin);
                SENSORLIB_LOG_D("Tx Channel:%d", buffer[48]);
                SENSORLIB_LOG_D("Rx Channel:%d", buffer[49]);
                SENSORLIB_LOG_D("Key Number:%d", buffer[27]);
                SENSORLIB_LOG_D("Resolution: %d x %d", _touchConfig.resolutionX, _touchConfig.resolutionY);
                SENSORLIB_LOG_D("Project ID:%04X", buffer[39] << 24 | buffer[38] << 16 | buffer[37] << 8 | buffer[36]);
                SENSORLIB_LOG_D("Chip Type:%04" PRIX32, _chipID);
                SENSORLIB_LOG_D("Firmware Version:%04X", buffer[35] << 24 | buffer[34] << 16 | buffer[33] << 8 | buffer[32]);
                return true;
            }
        }
        hal->delay(10);
    }
    return false;
}
 
 
#endif