fixes a signed / unsigned int comparison
initializes debounceMillis as an unsigned long (previously a signed long) to prevent the comparison conflict that arises on line 131 with debouncingMicros[i][j] which is an unsigned long
This commit is contained in:
wrongPaul
GitHub
parent
c65ece96fb
commit
2b11182da3
966
kolea.ino
966
kolea.ino
@ -1,484 +1,484 @@
|
|||||||
/**
|
/**
|
||||||
* StenoFW is a firmware for Stenoboard keyboards.
|
* StenoFW is a firmware for Stenoboard keyboards.
|
||||||
*
|
*
|
||||||
* This program is free software: you can redistribute it and/or modify
|
* 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
|
* it under the terms of the GNU General Public License as published by
|
||||||
* the Free Software Foundation, either version 3 of the License, or
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
* (at your option) any later version.
|
* (at your option) any later version.
|
||||||
*
|
*
|
||||||
* This program is distributed in the hope that it will be useful,
|
* This program is distributed in the hope that it will be useful,
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
* GNU General Public License for more details.
|
* GNU General Public License for more details.
|
||||||
*
|
*
|
||||||
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
||||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*
|
*
|
||||||
* Copyright 2014 Emanuele Caruso. See LICENSE.txt for details.
|
* Copyright 2014 Emanuele Caruso. See LICENSE.txt for details.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Matrix modified for the Kolea keyboard.
|
* Matrix modified for the Kolea keyboard.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define ROWS 4
|
#define ROWS 4
|
||||||
#define COLS 11
|
#define COLS 11
|
||||||
|
|
||||||
/* The following matrix is shown here for reference only.
|
/* The following matrix is shown here for reference only.
|
||||||
char keys[ROWS][COLS] = {
|
char keys[ROWS][COLS] = {
|
||||||
{' ', '2', '3', '4', '5', ' ', '7', '8', '9', '0', ' '},
|
{' ', '2', '3', '4', '5', ' ', '7', '8', '9', '0', ' '},
|
||||||
{' ', 'q', 'w', 'e', 'r', 't', 'u', 'i', 'o', 'p', '['},
|
{' ', 'q', 'w', 'e', 'r', 't', 'u', 'i', 'o', 'p', '['},
|
||||||
{' ', 'a', 's', 'd', 'f', 'g', 'j', 'k', 'l', ';', '\''},
|
{' ', 'a', 's', 'd', 'f', 'g', 'j', 'k', 'l', ';', '\''},
|
||||||
{' ', ' ', ' ', 'c', 'v', ' ', 'n', 'm', ' ', ' ', ' '}
|
{' ', ' ', ' ', 'c', 'v', ' ', 'n', 'm', ' ', ' ', ' '}
|
||||||
};*/
|
};*/
|
||||||
|
|
||||||
// Configuration variables
|
// Configuration variables
|
||||||
int rowPins[ROWS] = {4, 5, 6, 7};
|
int rowPins[ROWS] = {4, 5, 6, 7};
|
||||||
int colPins[COLS] = {8, 9, 10, 11, 12, 14, 15, 16, 18, 19, 20};
|
int colPins[COLS] = {8, 9, 10, 11, 12, 14, 15, 16, 18, 19, 20};
|
||||||
int ledPin = 3;
|
int ledPin = 3;
|
||||||
long debounceMillis = 20;
|
unsigned long debounceMillis = 20;
|
||||||
|
|
||||||
// Keyboard state variables
|
// Keyboard state variables
|
||||||
boolean isStrokeInProgress = false;
|
boolean isStrokeInProgress = false;
|
||||||
boolean currentChord[ROWS][COLS];
|
boolean currentChord[ROWS][COLS];
|
||||||
boolean currentKeyReadings[ROWS][COLS];
|
boolean currentKeyReadings[ROWS][COLS];
|
||||||
boolean debouncingKeys[ROWS][COLS];
|
boolean debouncingKeys[ROWS][COLS];
|
||||||
unsigned long debouncingMicros[ROWS][COLS];
|
unsigned long debouncingMicros[ROWS][COLS];
|
||||||
|
|
||||||
// Other state variables
|
// Other state variables
|
||||||
int ledIntensity = 1; // Min 0 - Max 255
|
int ledIntensity = 1; // Min 0 - Max 255
|
||||||
|
|
||||||
// Protocol state
|
// Protocol state
|
||||||
#define GEMINI 0
|
#define GEMINI 0
|
||||||
#define TXBOLT 1
|
#define TXBOLT 1
|
||||||
#define NKRO 2
|
#define NKRO 2
|
||||||
int protocol = GEMINI;
|
int protocol = GEMINI;
|
||||||
|
|
||||||
// This is called when the keyboard is connected
|
// This is called when the keyboard is connected
|
||||||
void setup() {
|
void setup() {
|
||||||
Keyboard.begin();
|
Keyboard.begin();
|
||||||
Serial.begin(9600);
|
Serial.begin(9600);
|
||||||
for (int i = 0; i < COLS; i++)
|
for (int i = 0; i < COLS; i++)
|
||||||
pinMode(colPins[i], INPUT_PULLUP);
|
pinMode(colPins[i], INPUT_PULLUP);
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
pinMode(rowPins[i], OUTPUT);
|
pinMode(rowPins[i], OUTPUT);
|
||||||
digitalWrite(rowPins[i], HIGH);
|
digitalWrite(rowPins[i], HIGH);
|
||||||
}
|
}
|
||||||
pinMode(ledPin, OUTPUT);
|
pinMode(ledPin, OUTPUT);
|
||||||
analogWrite(ledPin, ledIntensity);
|
analogWrite(ledPin, ledIntensity);
|
||||||
clearBooleanMatrixes();
|
clearBooleanMatrixes();
|
||||||
}
|
}
|
||||||
|
|
||||||
// Read key states and handle all chord events
|
// Read key states and handle all chord events
|
||||||
void loop() {
|
void loop() {
|
||||||
readKeys();
|
readKeys();
|
||||||
|
|
||||||
boolean isAnyKeyPressed = true;
|
boolean isAnyKeyPressed = true;
|
||||||
|
|
||||||
// If stroke is not in progress, check debouncing keys
|
// If stroke is not in progress, check debouncing keys
|
||||||
if (!isStrokeInProgress) {
|
if (!isStrokeInProgress) {
|
||||||
checkAlreadyDebouncingKeys();
|
checkAlreadyDebouncingKeys();
|
||||||
if (!isStrokeInProgress) checkNewDebouncingKeys();
|
if (!isStrokeInProgress) checkNewDebouncingKeys();
|
||||||
}
|
}
|
||||||
|
|
||||||
// If any key was pressed, record all pressed keys
|
// If any key was pressed, record all pressed keys
|
||||||
if (isStrokeInProgress) {
|
if (isStrokeInProgress) {
|
||||||
isAnyKeyPressed = recordCurrentKeys();
|
isAnyKeyPressed = recordCurrentKeys();
|
||||||
}
|
}
|
||||||
|
|
||||||
// If all keys have been released, send the chord and reset global state
|
// If all keys have been released, send the chord and reset global state
|
||||||
if (!isAnyKeyPressed) {
|
if (!isAnyKeyPressed) {
|
||||||
sendChord();
|
sendChord();
|
||||||
clearBooleanMatrixes();
|
clearBooleanMatrixes();
|
||||||
isStrokeInProgress = false;
|
isStrokeInProgress = false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Record all pressed keys into current chord. Return false if no key is currently pressed
|
// Record all pressed keys into current chord. Return false if no key is currently pressed
|
||||||
boolean recordCurrentKeys() {
|
boolean recordCurrentKeys() {
|
||||||
boolean isAnyKeyPressed = false;
|
boolean isAnyKeyPressed = false;
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
for (int j = 0; j < COLS; j++) {
|
for (int j = 0; j < COLS; j++) {
|
||||||
if (currentKeyReadings[i][j] == true) {
|
if (currentKeyReadings[i][j] == true) {
|
||||||
currentChord[i][j] = true;
|
currentChord[i][j] = true;
|
||||||
isAnyKeyPressed = true;
|
isAnyKeyPressed = true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return isAnyKeyPressed;
|
return isAnyKeyPressed;
|
||||||
}
|
}
|
||||||
|
|
||||||
// If a key is pressed, add it to debouncing keys and record the time
|
// If a key is pressed, add it to debouncing keys and record the time
|
||||||
void checkNewDebouncingKeys() {
|
void checkNewDebouncingKeys() {
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
for (int j = 0; j < COLS; j++) {
|
for (int j = 0; j < COLS; j++) {
|
||||||
if (currentKeyReadings[i][j] == true && debouncingKeys[i][j] == false) {
|
if (currentKeyReadings[i][j] == true && debouncingKeys[i][j] == false) {
|
||||||
debouncingKeys[i][j] = true;
|
debouncingKeys[i][j] = true;
|
||||||
debouncingMicros[i][j] = micros();
|
debouncingMicros[i][j] = micros();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Check already debouncing keys. If a key debounces, start chord recording.
|
// Check already debouncing keys. If a key debounces, start chord recording.
|
||||||
void checkAlreadyDebouncingKeys() {
|
void checkAlreadyDebouncingKeys() {
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
for (int j = 0; j < COLS; j++) {
|
for (int j = 0; j < COLS; j++) {
|
||||||
if (debouncingKeys[i][j] == true && currentKeyReadings[i][j] == false) {
|
if (debouncingKeys[i][j] == true && currentKeyReadings[i][j] == false) {
|
||||||
debouncingKeys[i][j] = false;
|
debouncingKeys[i][j] = false;
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
if (debouncingKeys[i][j] == true && micros() - debouncingMicros[i][j] / 1000 > debounceMillis) {
|
if (debouncingKeys[i][j] == true && micros() - debouncingMicros[i][j] / 1000 > debounceMillis) {
|
||||||
isStrokeInProgress = true;
|
isStrokeInProgress = true;
|
||||||
currentChord[i][j] = true;
|
currentChord[i][j] = true;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Set all values of all boolean matrixes to false
|
// Set all values of all boolean matrixes to false
|
||||||
void clearBooleanMatrixes() {
|
void clearBooleanMatrixes() {
|
||||||
clearBooleanMatrix(currentChord, false);
|
clearBooleanMatrix(currentChord, false);
|
||||||
clearBooleanMatrix(currentKeyReadings, false);
|
clearBooleanMatrix(currentKeyReadings, false);
|
||||||
clearBooleanMatrix(debouncingKeys, false);
|
clearBooleanMatrix(debouncingKeys, false);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Set all values of the passed matrix to the given value
|
// Set all values of the passed matrix to the given value
|
||||||
void clearBooleanMatrix(boolean booleanMatrix[][COLS], boolean value) {
|
void clearBooleanMatrix(boolean booleanMatrix[][COLS], boolean value) {
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
for (int j = 0; j < COLS; j++) {
|
for (int j = 0; j < COLS; j++) {
|
||||||
booleanMatrix[i][j] = value;
|
booleanMatrix[i][j] = value;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Read all keys
|
// Read all keys
|
||||||
void readKeys() {
|
void readKeys() {
|
||||||
for (int i = 0; i < ROWS; i++) {
|
for (int i = 0; i < ROWS; i++) {
|
||||||
digitalWrite(rowPins[i], LOW);
|
digitalWrite(rowPins[i], LOW);
|
||||||
for (int j = 0; j < COLS; j++)
|
for (int j = 0; j < COLS; j++)
|
||||||
currentKeyReadings[i][j] = digitalRead(colPins[j]) == LOW ? true : false;
|
currentKeyReadings[i][j] = digitalRead(colPins[j]) == LOW ? true : false;
|
||||||
digitalWrite(rowPins[i], HIGH);
|
digitalWrite(rowPins[i], HIGH);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Send current chord using NKRO Keyboard emulation
|
// Send current chord using NKRO Keyboard emulation
|
||||||
void sendChordNkro() {
|
void sendChordNkro() {
|
||||||
// QWERTY mapping
|
// QWERTY mapping
|
||||||
char qwertyMapping[ROWS][COLS] = {
|
char qwertyMapping[ROWS][COLS] = {
|
||||||
{' ', '2', '3', '4', '5', ' ', '7', '8', '9', '0', ' '},
|
{' ', '2', '3', '4', '5', ' ', '7', '8', '9', '0', ' '},
|
||||||
{' ', 'q', 'w', 'e', 'r', 't', 'u', 'i', 'o', 'p', '['},
|
{' ', 'q', 'w', 'e', 'r', 't', 'u', 'i', 'o', 'p', '['},
|
||||||
{' ', 'a', 's', 'd', 'f', 'g', 'j', 'k', 'l', ';', '\''},
|
{' ', 'a', 's', 'd', 'f', 'g', 'j', 'k', 'l', ';', '\''},
|
||||||
{' ', ' ', ' ', 'c', 'v', ' ', 'n', 'm', ' ', ' ', ' '}
|
{' ', ' ', ' ', 'c', 'v', ' ', 'n', 'm', ' ', ' ', ' '}
|
||||||
};
|
};
|
||||||
int keyCounter = 0;
|
int keyCounter = 0;
|
||||||
char qwertyKeys[ROWS * COLS];
|
char qwertyKeys[ROWS * COLS];
|
||||||
boolean firstKeyPressed = false;
|
boolean firstKeyPressed = false;
|
||||||
|
|
||||||
// Calculate qwerty keys array using qwertyMappings[][]
|
// Calculate qwerty keys array using qwertyMappings[][]
|
||||||
for (int i = 0; i < ROWS; i++)
|
for (int i = 0; i < ROWS; i++)
|
||||||
for (int j = 0; j < COLS; j++)
|
for (int j = 0; j < COLS; j++)
|
||||||
if (currentChord[i][j]) {
|
if (currentChord[i][j]) {
|
||||||
qwertyKeys[keyCounter] = qwertyMapping[i][j];
|
qwertyKeys[keyCounter] = qwertyMapping[i][j];
|
||||||
keyCounter++;
|
keyCounter++;
|
||||||
}
|
}
|
||||||
// Emulate keyboard key presses
|
// Emulate keyboard key presses
|
||||||
for (int i = 0; i < keyCounter; i++) {
|
for (int i = 0; i < keyCounter; i++) {
|
||||||
if (qwertyKeys[i] != ' ') {
|
if (qwertyKeys[i] != ' ') {
|
||||||
Keyboard.press(qwertyKeys[i]);
|
Keyboard.press(qwertyKeys[i]);
|
||||||
if (!firstKeyPressed) firstKeyPressed = true;
|
if (!firstKeyPressed) firstKeyPressed = true;
|
||||||
else Keyboard.release(qwertyKeys[i]);
|
else Keyboard.release(qwertyKeys[i]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
Keyboard.releaseAll();
|
Keyboard.releaseAll();
|
||||||
}
|
}
|
||||||
|
|
||||||
// Send current chord over serial using the Gemini protocol.
|
// Send current chord over serial using the Gemini protocol.
|
||||||
void sendChordGemini() {
|
void sendChordGemini() {
|
||||||
// Initialize chord bytes
|
// Initialize chord bytes
|
||||||
byte chordBytes[] = {B10000000, B0, B0, B0, B0, B0};
|
byte chordBytes[] = {B10000000, B0, B0, B0, B0, B0};
|
||||||
|
|
||||||
// Byte 0
|
// Byte 0
|
||||||
//#
|
//#
|
||||||
if (currentChord[0][1] || currentChord[0][2] || currentChord[0][3] || currentChord[0][4] || currentChord[0][6] || currentChord[0][7] || currentChord[0][8] || currentChord[0][9]) {
|
if (currentChord[0][1] || currentChord[0][2] || currentChord[0][3] || currentChord[0][4] || currentChord[0][6] || currentChord[0][7] || currentChord[0][8] || currentChord[0][9]) {
|
||||||
chordBytes[0] = B10000001;
|
chordBytes[0] = B10000001;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Byte 1
|
// Byte 1
|
||||||
//S
|
//S
|
||||||
if (currentChord[1][1] || currentChord[2][1]) {
|
if (currentChord[1][1] || currentChord[2][1]) {
|
||||||
chordBytes[1] += B01000000;
|
chordBytes[1] += B01000000;
|
||||||
}
|
}
|
||||||
//T
|
//T
|
||||||
if (currentChord[1][2]) {
|
if (currentChord[1][2]) {
|
||||||
chordBytes[1] += B00010000;
|
chordBytes[1] += B00010000;
|
||||||
}
|
}
|
||||||
//K
|
//K
|
||||||
if (currentChord[2][2]) {
|
if (currentChord[2][2]) {
|
||||||
chordBytes[1] += B00001000;
|
chordBytes[1] += B00001000;
|
||||||
}
|
}
|
||||||
//P
|
//P
|
||||||
if (currentChord[1][3]) {
|
if (currentChord[1][3]) {
|
||||||
chordBytes[1] += B00000100;
|
chordBytes[1] += B00000100;
|
||||||
}
|
}
|
||||||
//W
|
//W
|
||||||
if (currentChord[2][3]) {
|
if (currentChord[2][3]) {
|
||||||
chordBytes[1] += B00000010;
|
chordBytes[1] += B00000010;
|
||||||
}
|
}
|
||||||
//H
|
//H
|
||||||
if (currentChord[1][4]) {
|
if (currentChord[1][4]) {
|
||||||
chordBytes[1] += B00000001;
|
chordBytes[1] += B00000001;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Byte 2
|
// Byte 2
|
||||||
//R
|
//R
|
||||||
if (currentChord[2][4]) {
|
if (currentChord[2][4]) {
|
||||||
chordBytes[2] += B01000000;
|
chordBytes[2] += B01000000;
|
||||||
}
|
}
|
||||||
//W
|
//W
|
||||||
if (currentChord[3][3]) {
|
if (currentChord[3][3]) {
|
||||||
chordBytes[2] += B00100000;
|
chordBytes[2] += B00100000;
|
||||||
}
|
}
|
||||||
//O
|
//O
|
||||||
if (currentChord[3][4]) {
|
if (currentChord[3][4]) {
|
||||||
chordBytes[2] += B00010000;
|
chordBytes[2] += B00010000;
|
||||||
}
|
}
|
||||||
//*
|
//*
|
||||||
if (currentChord[1][5] || currentChord[2][5]) {
|
if (currentChord[1][5] || currentChord[2][5]) {
|
||||||
chordBytes[2] += B00001000;
|
chordBytes[2] += B00001000;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Byte 3
|
// Byte 3
|
||||||
//E
|
//E
|
||||||
if (currentChord[3][6]) {
|
if (currentChord[3][6]) {
|
||||||
chordBytes[3] += B00001000;
|
chordBytes[3] += B00001000;
|
||||||
}
|
}
|
||||||
//U
|
//U
|
||||||
if (currentChord[3][7]) {
|
if (currentChord[3][7]) {
|
||||||
chordBytes[3] += B00000100;
|
chordBytes[3] += B00000100;
|
||||||
}
|
}
|
||||||
//F
|
//F
|
||||||
if (currentChord[1][6]) {
|
if (currentChord[1][6]) {
|
||||||
chordBytes[3] += B00000010;
|
chordBytes[3] += B00000010;
|
||||||
}
|
}
|
||||||
//R
|
//R
|
||||||
if (currentChord[2][6]) {
|
if (currentChord[2][6]) {
|
||||||
chordBytes[3] += B00000001;
|
chordBytes[3] += B00000001;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Byte 4
|
// Byte 4
|
||||||
//P
|
//P
|
||||||
if (currentChord[1][7]) {
|
if (currentChord[1][7]) {
|
||||||
chordBytes[4] += B01000000;
|
chordBytes[4] += B01000000;
|
||||||
}
|
}
|
||||||
//B
|
//B
|
||||||
if (currentChord[2][7]) {
|
if (currentChord[2][7]) {
|
||||||
chordBytes[4] += B00100000;
|
chordBytes[4] += B00100000;
|
||||||
}
|
}
|
||||||
//L
|
//L
|
||||||
if (currentChord[1][8]) {
|
if (currentChord[1][8]) {
|
||||||
chordBytes[4] += B00010000;
|
chordBytes[4] += B00010000;
|
||||||
}
|
}
|
||||||
//G
|
//G
|
||||||
if (currentChord[2][8]) {
|
if (currentChord[2][8]) {
|
||||||
chordBytes[4] += B00001000;
|
chordBytes[4] += B00001000;
|
||||||
}
|
}
|
||||||
//T
|
//T
|
||||||
if (currentChord[1][9]) {
|
if (currentChord[1][9]) {
|
||||||
chordBytes[4] += B00000100;
|
chordBytes[4] += B00000100;
|
||||||
}
|
}
|
||||||
//S
|
//S
|
||||||
if (currentChord[2][9]) {
|
if (currentChord[2][9]) {
|
||||||
chordBytes[4] += B00000010;
|
chordBytes[4] += B00000010;
|
||||||
}
|
}
|
||||||
//D
|
//D
|
||||||
if (currentChord[1][10]) {
|
if (currentChord[1][10]) {
|
||||||
chordBytes[4] += B00000001;
|
chordBytes[4] += B00000001;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Byte 5
|
// Byte 5
|
||||||
//Z
|
//Z
|
||||||
if (currentChord[2][10]) {
|
if (currentChord[2][10]) {
|
||||||
chordBytes[5] += B00000001;
|
chordBytes[5] += B00000001;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Send chord bytes over serial
|
// Send chord bytes over serial
|
||||||
for (int i = 0; i < 6; i++) {
|
for (int i = 0; i < 6; i++) {
|
||||||
Serial.write(chordBytes[i]);
|
Serial.write(chordBytes[i]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void sendChordTxBolt() {
|
void sendChordTxBolt() {
|
||||||
byte chordBytes[] = {B0, B0, B0, B0, B0};
|
byte chordBytes[] = {B0, B0, B0, B0, B0};
|
||||||
int index = 0;
|
int index = 0;
|
||||||
|
|
||||||
// TX Bolt uses a variable length packet. Only those bytes that have active
|
// TX Bolt uses a variable length packet. Only those bytes that have active
|
||||||
// keys are sent. The header bytes indicate which keys are being sent. They
|
// keys are sent. The header bytes indicate which keys are being sent. They
|
||||||
// must be sent in order. It is a good idea to send a zero after every packet.
|
// must be sent in order. It is a good idea to send a zero after every packet.
|
||||||
// 00XXXXXX 01XXXXXX 10XXXXXX 110XXXXX
|
// 00XXXXXX 01XXXXXX 10XXXXXX 110XXXXX
|
||||||
// HWPKTS UE*OAR GLBPRF #ZDST
|
// HWPKTS UE*OAR GLBPRF #ZDST
|
||||||
|
|
||||||
// byte 1
|
// byte 1
|
||||||
// S-
|
// S-
|
||||||
if (currentChord[1][1] || currentChord[2][1]) chordBytes[index] |= B00000001;
|
if (currentChord[1][1] || currentChord[2][1]) chordBytes[index] |= B00000001;
|
||||||
// T-
|
// T-
|
||||||
if (currentChord[1][2]) chordBytes[index] |= B00000010;
|
if (currentChord[1][2]) chordBytes[index] |= B00000010;
|
||||||
// K-
|
// K-
|
||||||
if (currentChord[2][2]) chordBytes[index] |= B00000100;
|
if (currentChord[2][2]) chordBytes[index] |= B00000100;
|
||||||
// P-
|
// P-
|
||||||
if (currentChord[1][3]) chordBytes[index] |= B00001000;
|
if (currentChord[1][3]) chordBytes[index] |= B00001000;
|
||||||
// W-
|
// W-
|
||||||
if (currentChord[2][3]) chordBytes[index] |= B00010000;
|
if (currentChord[2][3]) chordBytes[index] |= B00010000;
|
||||||
// H-
|
// H-
|
||||||
if (currentChord[1][4]) chordBytes[index] |= B00100000;
|
if (currentChord[1][4]) chordBytes[index] |= B00100000;
|
||||||
// Increment the index if the current byte has any keys set.
|
// Increment the index if the current byte has any keys set.
|
||||||
if (chordBytes[index]) index++;
|
if (chordBytes[index]) index++;
|
||||||
|
|
||||||
// byte 2
|
// byte 2
|
||||||
// R-
|
// R-
|
||||||
if (currentChord[2][4]) chordBytes[index] |= B01000001;
|
if (currentChord[2][4]) chordBytes[index] |= B01000001;
|
||||||
// A
|
// A
|
||||||
if (currentChord[3][3]) chordBytes[index] |= B01000010;
|
if (currentChord[3][3]) chordBytes[index] |= B01000010;
|
||||||
// O
|
// O
|
||||||
if (currentChord[3][4]) chordBytes[index] |= B01000100;
|
if (currentChord[3][4]) chordBytes[index] |= B01000100;
|
||||||
// *
|
// *
|
||||||
if (currentChord[1][5] || currentChord[2][5]) chordBytes[index] |= B01001000;
|
if (currentChord[1][5] || currentChord[2][5]) chordBytes[index] |= B01001000;
|
||||||
// E
|
// E
|
||||||
if (currentChord[3][6]) chordBytes[index] |= B01010000;
|
if (currentChord[3][6]) chordBytes[index] |= B01010000;
|
||||||
// U
|
// U
|
||||||
if (currentChord[3][7]) chordBytes[index] |= B01100000;
|
if (currentChord[3][7]) chordBytes[index] |= B01100000;
|
||||||
// Increment the index if the current byte has any keys set.
|
// Increment the index if the current byte has any keys set.
|
||||||
if (chordBytes[index]) index++;
|
if (chordBytes[index]) index++;
|
||||||
|
|
||||||
// byte 3
|
// byte 3
|
||||||
// -F
|
// -F
|
||||||
if (currentChord[1][6]) chordBytes[index] |= B10000001;
|
if (currentChord[1][6]) chordBytes[index] |= B10000001;
|
||||||
// -R
|
// -R
|
||||||
if (currentChord[2][6]) chordBytes[index] |= B10000010;
|
if (currentChord[2][6]) chordBytes[index] |= B10000010;
|
||||||
// -P
|
// -P
|
||||||
if (currentChord[1][7]) chordBytes[index] |= B10000100;
|
if (currentChord[1][7]) chordBytes[index] |= B10000100;
|
||||||
// -B
|
// -B
|
||||||
if (currentChord[2][7]) chordBytes[index] |= B10001000;
|
if (currentChord[2][7]) chordBytes[index] |= B10001000;
|
||||||
// -L
|
// -L
|
||||||
if (currentChord[1][8]) chordBytes[index] |= B10010000;
|
if (currentChord[1][8]) chordBytes[index] |= B10010000;
|
||||||
// -G
|
// -G
|
||||||
if (currentChord[2][8]) chordBytes[index] |= B10100000;
|
if (currentChord[2][8]) chordBytes[index] |= B10100000;
|
||||||
// Increment the index if the current byte has any keys set.
|
// Increment the index if the current byte has any keys set.
|
||||||
if (chordBytes[index]) index++;
|
if (chordBytes[index]) index++;
|
||||||
|
|
||||||
// byte 4
|
// byte 4
|
||||||
// -T
|
// -T
|
||||||
if (currentChord[1][9]) chordBytes[index] |= B11000001;
|
if (currentChord[1][9]) chordBytes[index] |= B11000001;
|
||||||
// -S
|
// -S
|
||||||
if (currentChord[2][9]) chordBytes[index] |= B11000010;
|
if (currentChord[2][9]) chordBytes[index] |= B11000010;
|
||||||
// -D
|
// -D
|
||||||
if (currentChord[1][10]) chordBytes[index] |= B11000100;
|
if (currentChord[1][10]) chordBytes[index] |= B11000100;
|
||||||
// -Z
|
// -Z
|
||||||
if (currentChord[2][10]) chordBytes[index] |= B11001000;
|
if (currentChord[2][10]) chordBytes[index] |= B11001000;
|
||||||
// #
|
// #
|
||||||
if (currentChord[0][1] || currentChord[0][2] || currentChord[0][3] || currentChord[0][4] || currentChord[0][6] || currentChord[0][7] || currentChord[0][8] || currentChord[0][9]) chordBytes[index] |= B11010000;
|
if (currentChord[0][1] || currentChord[0][2] || currentChord[0][3] || currentChord[0][4] || currentChord[0][6] || currentChord[0][7] || currentChord[0][8] || currentChord[0][9]) chordBytes[index] |= B11010000;
|
||||||
// Increment the index if the current byte has any keys set.
|
// Increment the index if the current byte has any keys set.
|
||||||
if (chordBytes[index]) index++;
|
if (chordBytes[index]) index++;
|
||||||
|
|
||||||
// Now we have index bytes followed by a zero byte where 0 < index <= 4.
|
// Now we have index bytes followed by a zero byte where 0 < index <= 4.
|
||||||
index++; // Increment index to include the trailing zero byte.
|
index++; // Increment index to include the trailing zero byte.
|
||||||
for (int i = 0; i < index; i++) {
|
for (int i = 0; i < index; i++) {
|
||||||
Serial.write(chordBytes[i]);
|
Serial.write(chordBytes[i]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Send the chord using the current protocol. If there are fn keys
|
// Send the chord using the current protocol. If there are fn keys
|
||||||
// pressed, delegate to the corresponding function instead.
|
// pressed, delegate to the corresponding function instead.
|
||||||
// In future versions, there should also be a way to handle fn keys presses before
|
// In future versions, there should also be a way to handle fn keys presses before
|
||||||
// they are released, eg. for mouse emulation functionality or custom key presses.
|
// they are released, eg. for mouse emulation functionality or custom key presses.
|
||||||
void sendChord() {
|
void sendChord() {
|
||||||
// If fn keys have been pressed, delegate to corresponding method and return
|
// If fn keys have been pressed, delegate to corresponding method and return
|
||||||
if (currentChord[1][0] && currentChord[2][0]) {
|
if (currentChord[1][0] && currentChord[2][0]) {
|
||||||
fn1fn2();
|
fn1fn2();
|
||||||
return;
|
return;
|
||||||
} else if (currentChord[1][0]) {
|
} else if (currentChord[1][0]) {
|
||||||
fn1();
|
fn1();
|
||||||
return;
|
return;
|
||||||
} else if (currentChord[2][0]) {
|
} else if (currentChord[2][0]) {
|
||||||
fn2();
|
fn2();
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (protocol == NKRO) {
|
if (protocol == NKRO) {
|
||||||
sendChordNkro();
|
sendChordNkro();
|
||||||
} else if (protocol == GEMINI) {
|
} else if (protocol == GEMINI) {
|
||||||
sendChordGemini();
|
sendChordGemini();
|
||||||
} else {
|
} else {
|
||||||
sendChordTxBolt();
|
sendChordTxBolt();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Fn1 functions
|
// Fn1 functions
|
||||||
//
|
//
|
||||||
// This function is called when "fn1" key has been pressed, but not "fn2".
|
// This function is called when "fn1" key has been pressed, but not "fn2".
|
||||||
// Tip: maybe it is better to avoid using "fn1" key alone in order to avoid
|
// Tip: maybe it is better to avoid using "fn1" key alone in order to avoid
|
||||||
// accidental activation?
|
// accidental activation?
|
||||||
//
|
//
|
||||||
// Current functions:
|
// Current functions:
|
||||||
// PH-PB -> Set NKRO Keyboard emulation mode
|
// PH-PB -> Set NKRO Keyboard emulation mode
|
||||||
// PH-G -> Set Gemini PR protocol mode
|
// PH-G -> Set Gemini PR protocol mode
|
||||||
// PH-B -> Set TX Bolt protocol mode
|
// PH-B -> Set TX Bolt protocol mode
|
||||||
void fn1() {
|
void fn1() {
|
||||||
// "PH" -> Set protocol
|
// "PH" -> Set protocol
|
||||||
if (currentChord[1][3] && currentChord[1][4]) {
|
if (currentChord[1][3] && currentChord[1][4]) {
|
||||||
// "-PB" -> NKRO Keyboard
|
// "-PB" -> NKRO Keyboard
|
||||||
if (currentChord[1][7] && currentChord[2][7]) {
|
if (currentChord[1][7] && currentChord[2][7]) {
|
||||||
protocol = NKRO;
|
protocol = NKRO;
|
||||||
}
|
}
|
||||||
// "-G" -> Gemini PR
|
// "-G" -> Gemini PR
|
||||||
else if (currentChord[2][8]) {
|
else if (currentChord[2][8]) {
|
||||||
protocol = GEMINI;
|
protocol = GEMINI;
|
||||||
}
|
}
|
||||||
// "-B" -> TX Bolt
|
// "-B" -> TX Bolt
|
||||||
else if (currentChord[2][7]) {
|
else if (currentChord[2][7]) {
|
||||||
protocol = TXBOLT;
|
protocol = TXBOLT;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Fn2 functions
|
// Fn2 functions
|
||||||
//
|
//
|
||||||
// This function is called when "fn2" key has been pressed, but not "fn1".
|
// This function is called when "fn2" key has been pressed, but not "fn1".
|
||||||
// Tip: maybe it is better to avoid using "fn2" key alone in order to avoid
|
// Tip: maybe it is better to avoid using "fn2" key alone in order to avoid
|
||||||
// accidental activation?
|
// accidental activation?
|
||||||
//
|
//
|
||||||
// Current functions: none.
|
// Current functions: none.
|
||||||
void fn2() {
|
void fn2() {
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Fn1-Fn2 functions
|
// Fn1-Fn2 functions
|
||||||
//
|
//
|
||||||
// This function is called when both "fn1" and "fn1" keys have been pressed.
|
// This function is called when both "fn1" and "fn1" keys have been pressed.
|
||||||
//
|
//
|
||||||
// Current functions:
|
// Current functions:
|
||||||
// HR-P -> LED intensity up
|
// HR-P -> LED intensity up
|
||||||
// HR-F -> LED intensity down
|
// HR-F -> LED intensity down
|
||||||
void fn1fn2() {
|
void fn1fn2() {
|
||||||
// "HR" -> Change LED intensity
|
// "HR" -> Change LED intensity
|
||||||
if (currentChord[1][4] && currentChord[2][4]) {
|
if (currentChord[1][4] && currentChord[2][4]) {
|
||||||
// "-P" -> LED intensity up
|
// "-P" -> LED intensity up
|
||||||
if (currentChord[1][7]) {
|
if (currentChord[1][7]) {
|
||||||
if (ledIntensity == 0) ledIntensity +=1;
|
if (ledIntensity == 0) ledIntensity +=1;
|
||||||
else if(ledIntensity < 50) ledIntensity += 10;
|
else if(ledIntensity < 50) ledIntensity += 10;
|
||||||
else ledIntensity += 30;
|
else ledIntensity += 30;
|
||||||
if (ledIntensity > 255) ledIntensity = 0;
|
if (ledIntensity > 255) ledIntensity = 0;
|
||||||
analogWrite(ledPin, ledIntensity);
|
analogWrite(ledPin, ledIntensity);
|
||||||
}
|
}
|
||||||
// "-F" -> LED intensity down
|
// "-F" -> LED intensity down
|
||||||
if (currentChord[1][6]) {
|
if (currentChord[1][6]) {
|
||||||
if(ledIntensity == 0) ledIntensity = 255;
|
if(ledIntensity == 0) ledIntensity = 255;
|
||||||
else if(ledIntensity < 50) ledIntensity -= 10;
|
else if(ledIntensity < 50) ledIntensity -= 10;
|
||||||
else ledIntensity -= 30;
|
else ledIntensity -= 30;
|
||||||
if (ledIntensity < 1) ledIntensity = 0;
|
if (ledIntensity < 1) ledIntensity = 0;
|
||||||
analogWrite(ledPin, ledIntensity);
|
analogWrite(ledPin, ledIntensity);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user