mirror of
https://github.com/Keychron/qmk_firmware.git
synced 2024-12-13 05:38:51 +06:00
287 lines
9.1 KiB
C
Executable File
287 lines
9.1 KiB
C
Executable File
#ifdef ISSI_ENABLE
|
|
|
|
#include <stdlib.h>
|
|
#include <stdint.h>
|
|
#include <util/delay.h>
|
|
#include <avr/sfr_defs.h>
|
|
#include <avr/io.h>
|
|
#include <util/twi.h>
|
|
#include "issi.h"
|
|
#include "print.h"
|
|
#include "TWIlib.h"
|
|
|
|
#define ISSI_ADDR_DEFAULT 0xE8
|
|
|
|
#define ISSI_REG_CONFIG 0x00
|
|
#define ISSI_REG_CONFIG_PICTUREMODE 0x00
|
|
#define ISSI_REG_CONFIG_AUTOPLAYMODE 0x08
|
|
|
|
#define ISSI_CONF_PICTUREMODE 0x00
|
|
#define ISSI_CONF_AUTOFRAMEMODE 0x04
|
|
#define ISSI_CONF_AUDIOMODE 0x08
|
|
|
|
#define ISSI_REG_PICTUREFRAME 0x01
|
|
|
|
#define ISSI_REG_SHUTDOWN 0x0A
|
|
#define ISSI_REG_AUDIOSYNC 0x06
|
|
|
|
#define ISSI_COMMANDREGISTER 0xFD
|
|
#define ISSI_BANK_FUNCTIONREG 0x0B // helpfully called 'page nine'
|
|
uint8_t control[8][9] = {
|
|
{0, 0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0, 0},
|
|
{0, 0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0, 0},
|
|
{0, 0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0, 0},
|
|
{0, 0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0, 0},
|
|
};
|
|
ISSIDeviceStruct *issi_devices[4] = {0, 0, 0, 0};
|
|
|
|
#ifndef cbi
|
|
#define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit))
|
|
#endif
|
|
|
|
#ifndef sbi
|
|
#define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit))
|
|
#endif
|
|
|
|
#define I2C_WRITE 0
|
|
#define F_SCL 400000UL // SCL frequency
|
|
#define Prescaler 1
|
|
#define TWBR_val ((((F_CPU / F_SCL) / Prescaler) - 16 ) / 2)
|
|
|
|
uint8_t i2c_start(uint8_t address)
|
|
{
|
|
// reset TWI control register
|
|
TWCR = 0;
|
|
// transmit START condition
|
|
TWCR = (1<<TWINT) | (1<<TWSTA) | (1<<TWEN);
|
|
// wait for end of transmission
|
|
while( !(TWCR & (1<<TWINT)) );
|
|
|
|
// check if the start condition was successfully transmitted
|
|
if((TWSR & 0xF8) != TW_START){ return 1; }
|
|
|
|
// load slave address into data register
|
|
TWDR = address;
|
|
// start transmission of address
|
|
TWCR = (1<<TWINT) | (1<<TWEN);
|
|
// wait for end of transmission
|
|
while( !(TWCR & (1<<TWINT)) );
|
|
|
|
// check if the device has acknowledged the READ / WRITE mode
|
|
uint8_t twst = TW_STATUS & 0xF8;
|
|
if ( (twst != TW_MT_SLA_ACK) && (twst != TW_MR_SLA_ACK) ) return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
uint8_t i2c_write(uint8_t data)
|
|
{
|
|
// load data into data register
|
|
TWDR = data;
|
|
// start transmission of data
|
|
TWCR = (1 << TWINT) | (1 << TWEN);
|
|
// wait for end of transmission
|
|
while (!(TWCR & (1 << TWINT)))
|
|
;
|
|
|
|
if ((TWSR & 0xF8) != TW_MT_DATA_ACK) {
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
uint8_t i2c_transmit(uint8_t address, uint8_t* data, uint16_t length)
|
|
{
|
|
TWBR = (uint8_t)TWBR_val;
|
|
if (i2c_start(address | I2C_WRITE))
|
|
return 1;
|
|
for (uint16_t i = 0; i < length; i++) {
|
|
if (i2c_write(data[i]))
|
|
return 1;
|
|
}
|
|
// transmit STOP condition
|
|
TWCR = (1 << TWINT) | (1 << TWEN) | (1 << TWSTO);
|
|
return 0;
|
|
}
|
|
|
|
void setFrame(uint8_t device, uint8_t frame)
|
|
{
|
|
static uint8_t current_frame = -1;
|
|
if(current_frame != frame){
|
|
uint8_t payload[] = {
|
|
ISSI_ADDR_DEFAULT | device << 1,
|
|
ISSI_COMMANDREGISTER,
|
|
frame
|
|
};
|
|
TWITransmitData(payload, sizeof(payload), 0, 1);
|
|
}
|
|
// static uint8_t current_frame = 0xFF;
|
|
// if(current_frame == frame){
|
|
// // return;
|
|
// }
|
|
// uint8_t payload[2] = { ISSI_COMMANDREGISTER, frame };
|
|
// i2c_transmit(ISSI_ADDR_DEFAULT | device << 1, payload, 2);
|
|
// current_frame = frame;
|
|
}
|
|
|
|
void writeRegister8(uint8_t device, uint8_t frame, uint8_t reg, uint8_t data)
|
|
{
|
|
// Set the frame
|
|
setFrame(device, frame);
|
|
|
|
// Write to the register
|
|
uint8_t payload[] = {
|
|
ISSI_ADDR_DEFAULT | device << 1,
|
|
reg,
|
|
data
|
|
};
|
|
TWITransmitData(payload, sizeof(payload), 0, 1);
|
|
}
|
|
|
|
// void activateLED(uint8_t matrix, uint8_t cx, uint8_t cy, uint8_t pwm)
|
|
// {
|
|
// xprintf("activeLED: %02X %02X %02X %02X\n", matrix, cy, cx, pwm);
|
|
// uint8_t x = cx - 1; // funciton takes 1 based counts, but we need 0...
|
|
// uint8_t y = cy - 1; // creating them once for less confusion
|
|
// if(pwm == 0){
|
|
// cbi(control[matrix][y], x);
|
|
// }else{
|
|
// sbi(control[matrix][y], x);
|
|
// }
|
|
// uint8_t device = (matrix & 0x06) >> 1;
|
|
// uint8_t control_reg = (y << 1) | (matrix & 0x01);
|
|
// uint8_t pwm_reg = 0;
|
|
// switch(matrix & 0x01){
|
|
// case 0:
|
|
// pwm_reg = 0x24;
|
|
// break;
|
|
// case 1:
|
|
// pwm_reg = 0x2C;
|
|
// break;
|
|
// }
|
|
// pwm_reg += (y << 4) + x;
|
|
// xprintf(" device: %02X\n", device);
|
|
// xprintf(" control: %02X %02X\n", control_reg, control[matrix][y]);
|
|
// xprintf(" pwm: %02X %02X\n", pwm_reg, pwm);
|
|
// writeRegister8(device, 0, control_reg, control[matrix][y]);
|
|
// writeRegister8(device, 0, control_reg + 0x12, control[matrix][y]);
|
|
// writeRegister8(device, 0, pwm_reg, pwm);
|
|
// }
|
|
|
|
void activateLED(uint8_t matrix, uint8_t cx, uint8_t cy, uint8_t pwm)
|
|
{
|
|
uint8_t device_addr = (matrix & 0x06) >> 1;
|
|
ISSIDeviceStruct *device = issi_devices[device_addr];
|
|
if(device == 0){
|
|
return;
|
|
}
|
|
// xprintf("activeLED: %02X %02X %02X %02X\n", matrix, cy, cx, pwm);
|
|
uint8_t x = cx - 1; // funciton takes 1 based counts, but we need 0...
|
|
uint8_t y = cy - 1; // creating them once for less confusion
|
|
uint8_t control_reg = (y << 1) | (matrix & 0x01);
|
|
if(pwm == 0){
|
|
cbi(device->led_ctrl[control_reg], x);
|
|
cbi(device->led_blink_ctrl[control_reg], x);
|
|
}else{
|
|
sbi(device->led_ctrl[control_reg], x);
|
|
sbi(device->led_blink_ctrl[control_reg], x);
|
|
}
|
|
uint8_t pwm_reg = 0;
|
|
switch(matrix & 0x01){
|
|
case 0:
|
|
pwm_reg = 0x00;
|
|
break;
|
|
case 1:
|
|
pwm_reg = 0x08;
|
|
break;
|
|
}
|
|
pwm_reg += (y << 4) + x;
|
|
// xprintf(" device_addr: %02X\n", device_addr);
|
|
// xprintf(" control: %02X %02X\n", control_reg, control[matrix][y]);
|
|
// xprintf(" pwm: %02X %02X\n", pwm_reg, pwm);
|
|
// writeRegister8(device_addr, 0, control_reg, control[matrix][y]);
|
|
device->led_pwm[pwm_reg] = pwm;
|
|
device->led_dirty = 1;
|
|
|
|
// writeRegister8(device_addr, 0, control_reg + 0x12, control[matrix][y]);
|
|
// writeRegister8(device_addr, 0, pwm_reg, pwm);
|
|
}
|
|
|
|
void update_issi(uint8_t device_addr, uint8_t blocking)
|
|
{
|
|
// This seems to take about 6ms
|
|
ISSIDeviceStruct *device = issi_devices[device_addr];
|
|
if(device != 0){
|
|
if(device->fn_dirty){
|
|
device->fn_dirty = 0;
|
|
setFrame(device_addr, ISSI_BANK_FUNCTIONREG);
|
|
TWITransmitData(&device->fn_device_addr, sizeof(device->fn_registers) + 2, 0, 1);
|
|
}
|
|
if(device->led_dirty){
|
|
device->led_dirty = 0;
|
|
setFrame(device_addr, 0);
|
|
TWITransmitData(&device->led_device_addr, 0xB6, 0, blocking);
|
|
}
|
|
}
|
|
}
|
|
|
|
void issi_init(void)
|
|
{
|
|
// Set LED_EN/SDB high to enable the chip
|
|
xprintf("Enabing SDB on pin: %d\n", LED_EN_PIN);
|
|
_SFR_IO8((LED_EN_PIN >> 4) + 1) &= ~_BV(LED_EN_PIN & 0xF); // IN
|
|
_SFR_IO8((LED_EN_PIN >> 4) + 2) |= _BV(LED_EN_PIN & 0xF); // HI
|
|
TWIInit();
|
|
for(uint8_t device_addr = 0; device_addr < 4; device_addr++){
|
|
xprintf("ISSI Init device: %d\n", device_addr);
|
|
// If this device has been previously allocated, free it
|
|
if(issi_devices[device_addr] != 0){
|
|
free(issi_devices[device_addr]);
|
|
}
|
|
// Try to shutdown the device, if this fails skip this device
|
|
writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, ISSI_REG_SHUTDOWN, 0x00);
|
|
while (!isTWIReady()){_delay_us(1);}
|
|
if(TWIInfo.errorCode != 0xFF){
|
|
xprintf("ISSI init failed %d %02X %02X\n", device_addr, TWIInfo.mode, TWIInfo.errorCode);
|
|
continue;
|
|
}
|
|
// Allocate the device structure - calloc zeros it for us
|
|
ISSIDeviceStruct *device = (ISSIDeviceStruct *)calloc(sizeof(ISSIDeviceStruct) * 2, 1);
|
|
issi_devices[device_addr] = device;
|
|
device->fn_device_addr = ISSI_ADDR_DEFAULT | device_addr << 1;
|
|
device->fn_register_addr = 0;
|
|
device->led_device_addr = ISSI_ADDR_DEFAULT | device_addr << 1;
|
|
device->led_register_addr = 0;
|
|
// set dirty bits so that all of the buffered data is written out
|
|
device->fn_dirty = 1;
|
|
device->led_dirty = 1;
|
|
update_issi(device_addr, 1);
|
|
// Set the function register to picture mode
|
|
// device->fn_reg[ISSI_REG_CONFIG] = ISSI_REG_CONFIG_PICTUREMODE;
|
|
writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, ISSI_REG_SHUTDOWN, 0x01);
|
|
}
|
|
|
|
// Shutdown and set all registers to 0
|
|
// writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, ISSI_REG_SHUTDOWN, 0x00);
|
|
// for(uint8_t bank = 0; bank <= 7; bank++){
|
|
// for (uint8_t reg = 0x00; reg <= 0xB3; reg++) {
|
|
// writeRegister8(device_addr, bank, reg, 0x00);
|
|
// }
|
|
// }
|
|
// for (uint8_t reg = 0; reg <= 0x0C; reg++) {
|
|
// writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, reg, 0x00);
|
|
// }
|
|
// writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, ISSI_REG_CONFIG, ISSI_REG_CONFIG_PICTUREMODE);
|
|
// writeRegister8(device_addr, ISSI_BANK_FUNCTIONREG, ISSI_REG_SHUTDOWN, 0x01);
|
|
// picture mode
|
|
// writeRegister8(ISSI_BANK_FUNCTIONREG, 0x01, 0x01);
|
|
|
|
//Enable blink
|
|
// writeRegister8(ISSI_BANK_FUNCTIONREG, 0x05, 0x48B);
|
|
|
|
//Enable Breath
|
|
|
|
}
|
|
|
|
#endif
|