cm/cmdr-keyboard
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Started migration to Keyboard 42

Browse Source
This commit is contained in:
Christoffer Martinsson 2022-10-09 19:16:08 +02:00
parent 2543e8bdb0
commit c367ed33d5
2 changed files with 68 additions and 436 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
firmware/platformio.ini
View File

@ -8,9 +8,9 @@
; Please visit documentation for the other options and examples ; Please visit documentation for the other options and examples
; http://docs.platformio.org/page/projectconf.html ; http://docs.platformio.org/page/projectconf.html
[env:teensy40] [env:teensylc]
platform = teensy platform = teensy
board = teensy40 board = teensylc
framework = arduino framework = arduino
build_flags = -D USB_HID -D LAYOUT_SWEDISH -w build_flags = -D USB_HID -D LAYOUT_SWEDISH -w
board_build.f_cpu = 72000000L board_build.f_cpu = 48000000L

498
firmware/src/main.cpp
View File

@ -43,61 +43,12 @@
#include <Arduino.h> #include <Arduino.h>
#include <EEPROM.h> #include <EEPROM.h>
#include <Keypad.h> #include <Keypad.h>
#include "USBHost_t36.h"
#define HID_AXIS_MAX 1023
#define HID_AXIS_MIN 0
#define HID_AXIS_CENTER 512
#define AXIS_MAX 4096
#define AXIS_MIN 0
#define AXIS_CENTER 2048
#define DEADZONE_X 50
#define DEADZONE_Y 50
#define USB_LED_NUM_LOCK 0 #define USB_LED_NUM_LOCK 0
#define USB_LED_CAPS_LOCK 1 #define USB_LED_CAPS_LOCK 1
#define USB_LED_SCROLL_LOCK 2 #define USB_LED_SCROLL_LOCK 2
#define KEY_OFFSET 0xAA00 #define KEY_OFFSET 0xAA00
#define NO_JOY 0
#define JOY_A1 1 + KEY_OFFSET
#define JOY_A2 2 + KEY_OFFSET
#define JOY_A3 3 + KEY_OFFSET
#define JOY_A4 4 + KEY_OFFSET
#define JOY_A5 5 + KEY_OFFSET
#define JOY_A6 6 + KEY_OFFSET
#define JOY_A7 7 + KEY_OFFSET
#define JOY_A8 8 + KEY_OFFSET
#define JOY_A9 9 + KEY_OFFSET
#define JOY_A10 10 + KEY_OFFSET
#define JOY_A11 11 + KEY_OFFSET
#define JOY_A12 12 + KEY_OFFSET
#define JOY_A13 13 + KEY_OFFSET
#define JOY_A14 14 + KEY_OFFSET
#define JOY_A15 15 + KEY_OFFSET
#define JOY_A16 16 + KEY_OFFSET
#define JOY_A17 17 + KEY_OFFSET
#define JOY_A18 18 + KEY_OFFSET
#define JOY_A19 19 + KEY_OFFSET
#define JOY_A20 20 + KEY_OFFSET
#define JOY_A21 21 + KEY_OFFSET
#define JOY_A22 22 + KEY_OFFSET
#define JOY_A23 23 + KEY_OFFSET
#define JOY_A24 24 + KEY_OFFSET
#define JOY_A25 25 + KEY_OFFSET
#define JOY_A26 26 + KEY_OFFSET
#define JOY_A27 27 + KEY_OFFSET
#define JOY_A28 28 + KEY_OFFSET
#define JOY_A29 29 + KEY_OFFSET
#define JOY_A30 30 + KEY_OFFSET
#define JOY_A31 31 + KEY_OFFSET
#define JOY_A32 32 + KEY_OFFSET
#define JOY_AHU1 49 + KEY_OFFSET
#define JOY_AHR1 50 + KEY_OFFSET
#define JOY_AHD1 51 + KEY_OFFSET
#define JOY_AHL1 52 + KEY_OFFSET
#define KEY_MWU 53 + KEY_OFFSET #define KEY_MWU 53 + KEY_OFFSET
#define KEY_MWD 54 + KEY_OFFSET #define KEY_MWD 54 + KEY_OFFSET
@ -109,139 +60,71 @@
#define KEY_FN1 60 + KEY_OFFSET #define KEY_FN1 60 + KEY_OFFSET
#define KEY_FN2 61 + KEY_OFFSET #define KEY_FN2 61 + KEY_OFFSET
#define KEY_FN3 62 + KEY_OFFSET #define KEY_TAP1 62 + KEY_OFFSET
#define KEY_FN4 63 + KEY_OFFSET #define KEY_TAP2 63 + KEY_OFFSET
#define KEY_FN2L 64 + KEY_OFFSET #define KEY_TAP3 64 + KEY_OFFSET
#define KEY_FN2R 65 + KEY_OFFSET #define KEY_TAP4 65 + KEY_OFFSET
#define KEY_TAP5 66 + KEY_OFFSET
#define KEY_TAP6 67 + KEY_OFFSET
#define KEY_TAP7 68 + KEY_OFFSET
#define JOY_BTN1 71 + KEY_OFFSET #define NBR_OF_FN 3
#define JOY_BTN2 72 + KEY_OFFSET #define NBR_OF_TAP 7
#define JOY_BTN3 73 + KEY_OFFSET
#define JOY_BTN4 74 + KEY_OFFSET
#define JOY_BTN5 75 + KEY_OFFSET
#define JOY_BTN6 76 + KEY_OFFSET
#define JOY_BTN7 77 + KEY_OFFSET
#define JOY_BTN8 78 + KEY_OFFSET
#define JOY_FN1 JOY_BTN3
#define JOY_FN2 JOY_BTN7
#define KEY_PST 79 + KEY_OFFSET // Port toggle
#define KEY_PS0 80 + KEY_OFFSET // Port select
#define KEY_PS1 81 + KEY_OFFSET
#define KEY_PS2 82 + KEY_OFFSET
#define KEY_D1S0 83 + KEY_OFFSET // Display 1 select
#define KEY_D1S1 84 + KEY_OFFSET
#define KEY_D1S2 85 + KEY_OFFSET
#define KEY_D2S0 86 + KEY_OFFSET // Display 2 select
#define KEY_D2S1 87 + KEY_OFFSET
#define KEY_D2S2 88 + KEY_OFFSET
#define KEY_D2S3 89 + KEY_OFFSET
#define NBR_OF_FN 4+1
byte kp_buttons[64][3];
byte tb_buttons[8][3];
byte kp_buttons[48][3];
// Keypad button mapping // Keypad button mapping
const uint16_t kp_keys[64][NBR_OF_FN] = { const uint16_t kp_keys[48][NBR_OF_FN] = {
// Left keypad
// Fn 0 Fn 1 Fn 2 Fn 3 Fn 4 // Fn 0 Fn 1 Fn 2 Fn 3 Fn 4
// Standard keys Sec Standard keys F and Special keys Sec F and Special keys Special keys // Standard keys Sec Standard keys F and Special keys Sec F and Special keys Special keys
{KEY_ESC, KEY_TILDE, NO_KEY, NO_KEY, NO_KEY}, {KEY_TAP1, KEY_TAP1, KEY_TAP1},
{KEY_1, NO_KEY, KEY_F1, KEY_D1S0, NO_KEY}, {KEY_Q, KEY_F1, KEY_F1},
{KEY_2, NO_KEY, KEY_F2, KEY_D1S1, NO_KEY}, {KEY_W, KEY_F2, KEY_F2},
{KEY_3, NO_KEY, KEY_F3, KEY_D1S2, NO_KEY}, {KEY_E, KEY_F3, KEY_F3},
{KEY_4, NO_KEY, KEY_F4, NO_KEY, NO_KEY}, {KEY_R, KEY_F4, KEY_F4},
{KEY_5, NO_KEY, KEY_F5, NO_KEY, NO_KEY}, {KEY_T, KEY_F5, KEY_F5},
{KEY_FN2L, KEY_FN2L, KEY_FN2L, KEY_FN2L, KEY_FN2L}, {KEY_Y, KEY_F6, KEY_FN},
{KEY_Q, NO_KEY, KEY_PST, KEY_D2S3, NO_KEY}, {KEY_U, KEY_F7, KEY_PS},
{KEY_W, NO_KEY, KEY_PS0, KEY_D2S1, NO_KEY}, {KEY_I, KEY_F8, KEY_PS},
{KEY_E, NO_KEY, KEY_PS1, KEY_D2S2, NO_KEY}, {KEY_O, KEY_F9, KEY_PS},
{KEY_R, NO_KEY, KEY_PS2, NO_KEY, NO_KEY}, {KEY_P, KEY_F10, KEY_PS},
{KEY_T, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {'å', KEY_F11, NO_KEY},
{KEY_LEFT_CTRL, KEY_LEFT_CTRL, KEY_LEFT_CTRL, KEY_LEFT_CTRL, NO_KEY}, {KEY_TAP2, KEY_TAP2, KEY_TAP2},
{KEY_A, NO_KEY, KEY_MEDIA_PLAY_PAUSE, NO_KEY, NO_KEY}, {KEY_A, KEY_1, KEY_MEDIA_PLAY_PAUSE},
{KEY_S, NO_KEY, KEY_MEDIA_NEXT_TRACK, NO_KEY, NO_KEY}, {KEY_S, KEY_2, KEY_MEDIA_NEXT_TRACK},
{KEY_D, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {KEY_D, KEY_3, NO_KEY},
{KEY_F, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {KEY_F, KEY_4, NO_KEY},
{KEY_G, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {KEY_G, KEY_5, NO_KEY},
{KEY_LEFT_SHIFT, KEY_LEFT_SHIFT, KEY_LEFT_SHIFT, KEY_LEFT_SHIFT, NO_KEY}, {KEY_H, KEY_6, KEY_LEFT_SHIFT},
{KEY_Z, '<', NO_KEY, NO_KEY, NO_KEY}, {KEY_J, KEY_7, NO_KEY},
{KEY_X, NO_KEY, KEY_M3, NO_KEY, NO_KEY}, {KEY_K, KEY_8, KEY_M3},
{KEY_C, NO_KEY, NO_KEY, NO_KEY, KEY_CAPS_LOCK}, {KEY_L, KEY_9, NO_KEY},
{KEY_V, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {'ö', KEY_0, NO_KEY},
{KEY_B, NO_KEY, NO_KEY, NO_KEY, NO_KEY}, {'ä', KEY_EQUAL, NO_KEY},
{KEY_LEFT_GUI, KEY_LEFT_GUI, KEY_LEFT_GUI, KEY_LEFT_GUI, NO_KEY}, {KEY_TAP3, KEY_TAP3, KEY_TAP3},
{KEY_FN1, KEY_FN1, KEY_FN1, KEY_FN1, KEY_FN1}, {KEY_Z, '§', KEY_FN1},
{KEY_LEFT_ALT, KEY_LEFT_ALT, KEY_LEFT_ALT, KEY_LEFT_ALT, NO_KEY}, {KEY_X, NO_KEY, KEY_LEFT_ALT},
{KEY_SPACE, KEY_SPACE, KEY_SPACE, KEY_SPACE, NO_KEY}, {KEY_C, NO_KEY, KEY_SPACE},
{JOY_BTN1, JOY_BTN1, JOY_BTN1, JOY_BTN1, JOY_BTN1}, {KEY_V, '<', KEY_F6},
{JOY_BTN2, JOY_BTN2, JOY_BTN2, JOY_BTN2, JOY_BTN2}, {KEY_B, NO_KEY, KEY_F7},
{JOY_BTN3, JOY_BTN3, JOY_BTN3, JOY_BTN3, JOY_BTN3}, {KEY_N, NO_KEY, KEY_F8},
{JOY_BTN4, JOY_BTN4, JOY_BTN4, JOY_BTN4, JOY_BTN4}, {KEY_M, KEY_BACKSLASH, KEY_F9},
// Right keypad {KEY_COMMA, KEY_RIGHT_BRACE, KEY_F10},
// Fn 0 Fn 1 Fn 2 Fn 3 Fn 4 {KEY_PERIOD, KEY_MINUS, NO_KEY},
// Standard keys Sec Standard keys F and Special keys Sec F and Special keys Special keys {KEY_SLASH, NO_KEY, NO_KEY},
{KEY_6, NO_KEY, KEY_F6, KEY_HOME, NO_KEY}, {KEY_TAP4, KEY_TAP4, KEY_TAP4},
{KEY_7, NO_KEY, KEY_F7, KEY_END, NO_KEY}, {NO_KEY, NO_KEY, NO_KEY},
{KEY_8, NO_KEY, KEY_F8, KEY_INSERT, KEY_F13}, {NO_KEY, NO_KEY, NO_KEY},
{KEY_9, KEY_MINUS, KEY_F9, KEY_F11, KEY_F14}, {NO_KEY, NO_KEY, NO_KEY},
{KEY_0, KEY_EQUAL, KEY_F10, KEY_F12, KEY_F15}, {KEY_TAP5, KEY_TAP5, KEY_TAP5},
{KEY_DELETE, KEY_PRINTSCREEN, NO_KEY, NO_KEY, NO_KEY}, {KEY_LEFT_ALT, KEY_LEFT_ALT, KEY_LEFT_ALT},
{KEY_Y, NO_KEY, JOY_A28, NO_KEY, NO_KEY}, {KEY_TAP6, KEY_TAP6, KEY_TAP6},
{KEY_U, NO_KEY, JOY_A29, NO_KEY, NO_KEY}, {KEY_TAP7, KEY_TAP7, KEY_TAP7},
{KEY_I, NO_KEY, JOY_A30, NO_KEY, KEY_F16}, {KEY_RIGHT_ALT, KEY_RIGHT_ALT, KEY_RIGHT_ALT},
{KEY_O, 'å', JOY_A31, NO_KEY, KEY_F17}, {KEY_LEFT_GUI, KEY_LEFT_GUI, KEY_LEFT_GUI},
{KEY_P, KEY_RIGHT_BRACE, JOY_A32, NO_KEY, KEY_F18}, {NO_KEY, NO_KEY, NO_KEY},
{KEY_FN2R, KEY_FN2R, KEY_FN2R, KEY_FN2R, NO_KEY}, {NO_KEY, NO_KEY, NO_KEY},
{KEY_H, NO_KEY, KEY_LEFT, NO_KEY, NO_KEY}, {NO_KEY, NO_KEY, NO_KEY}
{KEY_J, KEY_PAGE_DOWN, KEY_DOWN, NO_KEY, NO_KEY},
{KEY_K, KEY_PAGE_UP, KEY_UP, NO_KEY, KEY_F19},
{KEY_L, 'ä', KEY_RIGHT, NO_KEY, KEY_F20},
{'ö', KEY_BACKSLASH, NO_KEY, NO_KEY, KEY_F21},
{KEY_ENTER, KEY_ENTER, KEY_ENTER, KEY_ENTER, NO_KEY},
{KEY_N, KEY_M2, NO_KEY, NO_KEY, NO_KEY},
{KEY_M, NO_KEY, NO_KEY, NO_KEY, NO_KEY},
{KEY_COMMA, NO_KEY, NO_KEY, NO_KEY, KEY_F22},
{KEY_PERIOD, NO_KEY, NO_KEY, NO_KEY, KEY_F23},
{KEY_SLASH, NO_KEY, NO_KEY, NO_KEY, KEY_F24},
{KEY_RIGHT_SHIFT, KEY_RIGHT_SHIFT, KEY_RIGHT_SHIFT, KEY_RIGHT_SHIFT, NO_KEY},
{KEY_SPACE, NO_KEY, NO_KEY, NO_KEY, NO_KEY},
{KEY_RIGHT_ALT, KEY_RIGHT_ALT, KEY_RIGHT_ALT, KEY_RIGHT_ALT, NO_KEY},
{KEY_FN1, KEY_FN1, KEY_FN1, KEY_FN1, KEY_FN1},
{KEY_FN4, KEY_FN4, KEY_FN4, KEY_FN4, KEY_FN4},
{JOY_BTN5, JOY_BTN5, JOY_BTN5, JOY_BTN5, JOY_BTN5},
{JOY_BTN6, JOY_BTN6, JOY_BTN6, JOY_BTN6, JOY_BTN6},
{JOY_BTN7, JOY_BTN7, JOY_BTN7, JOY_BTN7, JOY_BTN7},
{JOY_BTN8, JOY_BTN8, JOY_BTN8, JOY_BTN8, JOY_BTN8},
};
// Joystick button mapping
const uint16_t joy_keys[8][NBR_OF_FN] = {
// Fn 0 Fn 1 Fn 2 Fn 3 N/A
{JOY_A1, JOY_A9, JOY_A14, JOY_A19, NO_JOY}, // L1
{JOY_A2, JOY_A10, JOY_A15, JOY_A20, NO_JOY}, // L2
{JOY_A3, JOY_A3, JOY_A3, JOY_A3, NO_JOY}, // L3 Joy Fn1
{JOY_A4, JOY_A11, JOY_A16, JOY_A21, NO_JOY}, // L4
{JOY_A5, JOY_A12, JOY_A17, JOY_A22, NO_JOY}, // R1
{JOY_A6, JOY_A6, JOY_A6, JOY_A23, NO_JOY}, // R2
{JOY_A7, JOY_A7, JOY_A7, JOY_A7, NO_JOY}, // R3 Joy Fn2
{JOY_A8, JOY_A13, JOY_A18, JOY_A24, NO_JOY}, // R4
};
// Trackball button mapping
const uint16_t tb_keys[8][NBR_OF_FN] = {
// Fn 0 Fn 1 Fn 2 Fn 3 Fn 4
{KEY_M2, KEY_M2, KEY_M2, KEY_M3, KEY_M2},
{KEY_M1, KEY_M1, KEY_M1, KEY_M1, KEY_M1},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
{KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3, KEY_FN3},
}; };
struct Fn_tap{ struct Fn_tap{
@ -254,37 +137,17 @@ struct Fn_tap{
uint16_t trigger_keycode = NO_KEY; uint16_t trigger_keycode = NO_KEY;
uint16_t target_keycode = NO_KEY; uint16_t target_keycode = NO_KEY;
int kp_fn_mode = 0; int kp_fn_mode = 0;
int joy_fn_mode = 0;
bool fn_fast_switch = true; bool fn_fast_switch = true;
}; };
int fn_kp_key_found = 0; int fn_kp_key_found = 0;
int fn_joy_key_found = 0;
int kp_fn_mode = 0; int kp_fn_mode = 0;
int joy_fn_mode = 0; Fn_tap fn_tap[NBR_OF_TAP];
Fn_tap fn_tap[4];
int mouse_wheel = 0; int mouse_wheel = 0;
const int POWER_LED = 13; const int POWER_LED = 13;
enum EEPROM_ADR
{
MAX_X_ADR_HIGH,
MAX_X_ADR_LOW,
MIN_X_ADR_HIGH,
MIN_X_ADR_LOW,
CNT_X_ADR_HIGH,
CNT_X_ADR_LOW,
MAX_Y_ADR_HIGH,
MAX_Y_ADR_LOW,
MIN_Y_ADR_HIGH,
MIN_Y_ADR_LOW,
CNT_Y_ADR_HIGH,
CNT_Y_ADR_LOW,
EEPROM_ADR_NBR_OF_BYTES
};
unsigned long current_timestamp = 0; unsigned long current_timestamp = 0;
unsigned long button_timestamp = 0; unsigned long button_timestamp = 0;
unsigned long mouse_wheel_timestamp = 0; unsigned long mouse_wheel_timestamp = 0;
@ -292,83 +155,14 @@ unsigned long mouse_wheel_timestamp = 0;
const byte KP_ROWS = 5; const byte KP_ROWS = 5;
const byte KP_COLS = 6; const byte KP_COLS = 6;
const byte JOY_ROWS = 2;
const byte JOY_COLS = 2;
byte buttons[32];
int joystick_counter = 0;
int joystick_x = 0;
int joystick_x_raw = 0;
int joystick_x_max = 4096;
int joystick_x_min = 0;
int joystick_x_center = joystick_x_max/2;
int joystick_y = 0;
int joystick_y_raw = 0;
int joystick_y_max = 4096;
int joystick_y_min = 0;
int joystick_y_center = joystick_y_max/2;
float exp_constant = 0.2;
#define CALIBRATION_OFF 0
#define CALIBRATION_CENTER 1
#define CALIBRATION_MINMAX 2
int joystick_calibration_mode = 0;
byte kp_rowPins[KP_ROWS] = {2,3,4,5,6}; byte kp_rowPins[KP_ROWS] = {2,3,4,5,6};
byte kp_colPins[KP_COLS] = {9,10,11,12,14,15}; byte kp_colPins[KP_COLS] = {9,10,11,12,14,15};
Keypad kp_keypad = Keypad(makeKeymap(kp_keys), kp_rowPins, kp_colPins, KP_ROWS, KP_COLS); Keypad kp_keypad = Keypad(makeKeymap(kp_keys), kp_rowPins, kp_colPins, KP_ROWS, KP_COLS);
byte joy_rowPins[JOY_ROWS] = {21,18};
byte joy_colPins[JOY_COLS] = {20,19};
Keypad joy_keypad = Keypad(makeKeymap(joy_keys), joy_rowPins, joy_colPins, JOY_ROWS, JOY_COLS);
USBHost myusb;
USBHIDParser hid1(myusb);
MouseController mouse1(myusb);
int mouse_x = 0; int mouse_x = 0;
int mouse_y = 0; int mouse_y = 0;
void save_to_eeprom(){
EEPROM.write(MAX_X_ADR_LOW, joystick_x_max);
EEPROM.write(MAX_X_ADR_HIGH, joystick_x_max >> 8);
EEPROM.write(MIN_X_ADR_LOW, joystick_x_min);
EEPROM.write(MIN_X_ADR_HIGH, joystick_x_min >> 8);
EEPROM.write(CNT_X_ADR_LOW, joystick_x_center);
EEPROM.write(CNT_X_ADR_HIGH, joystick_x_center >> 8);
EEPROM.write(MAX_Y_ADR_LOW, joystick_y_max);
EEPROM.write(MAX_Y_ADR_HIGH, joystick_y_max >> 8);
EEPROM.write(MIN_Y_ADR_LOW, joystick_y_min);
EEPROM.write(MIN_Y_ADR_HIGH, joystick_y_min >> 8);
EEPROM.write(CNT_Y_ADR_LOW, joystick_y_center);
EEPROM.write(CNT_Y_ADR_HIGH, joystick_y_center >> 8);
}
void load_from_eeprom(){
joystick_x_max = (EEPROM.read(MAX_X_ADR_HIGH) << 8);
joystick_x_max |= EEPROM.read(MAX_X_ADR_LOW);
joystick_x_min = (EEPROM.read(MIN_X_ADR_HIGH) << 8);
joystick_x_min |= EEPROM.read(MIN_X_ADR_LOW);
joystick_x_center = (EEPROM.read(CNT_X_ADR_HIGH) << 8);
joystick_x_center |= EEPROM.read(CNT_X_ADR_LOW);
joystick_y_max = (EEPROM.read(MAX_Y_ADR_HIGH) << 8);
joystick_y_max |= EEPROM.read(MAX_Y_ADR_LOW);
joystick_y_min = (EEPROM.read(MIN_Y_ADR_HIGH) << 8);
joystick_y_min |= EEPROM.read(MIN_Y_ADR_LOW);
joystick_y_center = (EEPROM.read(CNT_Y_ADR_HIGH) << 8);
joystick_y_center |= EEPROM.read(CNT_Y_ADR_LOW);
}
void update_key(uint16_t keycode, uint8_t kstate) { void update_key(uint16_t keycode, uint8_t kstate) {
// Mouse buttons // Mouse buttons
if (keycode >= KEY_M1 && keycode <= KEY_MF) { if (keycode >= KEY_M1 && keycode <= KEY_MF) {
@ -392,37 +186,6 @@ void update_key(uint16_t keycode, uint8_t kstate) {
} }
} }
// Keypad Joystick buttons
else if (keycode >= JOY_BTN1 && keycode <= JOY_BTN8) {
int joy_keys_index = ((keycode-KEY_OFFSET)-(JOY_BTN1-KEY_OFFSET));
if (kstate == RELEASED) {
// Release all fn buttons related to this button
for (int j = 0; j < NBR_OF_FN; j++){
update_key(joy_keys[joy_keys_index][j], RELEASED);
}
} else if (kstate == PRESSED) {
update_key(joy_keys[joy_keys_index][joy_fn_mode], PRESSED);
}
}
// Joystick buttons
else if (keycode >= JOY_A1 && keycode <= JOY_A32) {
if (kstate == RELEASED) {
Joystick.button(keycode-KEY_OFFSET, false);
} else if (kstate == PRESSED) {
Joystick.button(keycode-KEY_OFFSET, true);
}
}
// Joystick hat
else if (keycode >= JOY_AHU1 && keycode <= JOY_AHL1) {
if (kstate == RELEASED) {
Joystick.hat(-1);
} else if (kstate == PRESSED) {
Joystick.hat(((keycode-KEY_OFFSET)-(JOY_AHU1-KEY_OFFSET)) * 90);
}
}
// Normal keyboard keys // Normal keyboard keys
else { else {
if ((( if (((
@ -452,17 +215,11 @@ void update_key(uint16_t keycode, uint8_t kstate) {
} }
void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_element){ void process_table(byte buttons[][3], const uint16_t keys[][3], int nbr_of_element){
for (int i = 0; i < nbr_of_element; i++) { for (int i = 0; i < nbr_of_element; i++) {
if (buttons[i][2] == PRESSED && if (buttons[i][2] == PRESSED &&
keys[i][0] != JOY_FN1 &&
keys[i][0] != JOY_FN2 &&
keys[i][0] != KEY_FN1 && keys[i][0] != KEY_FN1 &&
keys[i][0] != KEY_FN2 && keys[i][0] != KEY_FN2) {
keys[i][0] != KEY_FN2L &&
keys[i][0] != KEY_FN2R &&
keys[i][0] != KEY_FN3 &&
keys[i][0] != KEY_FN4) {
// Press key linked to the FN layer for this button // Press key linked to the FN layer for this button
if (keys[i][kp_fn_mode] != NO_KEY) { if (keys[i][kp_fn_mode] != NO_KEY) {
update_key(keys[i][kp_fn_mode], PRESSED); update_key(keys[i][kp_fn_mode], PRESSED);
@ -472,20 +229,11 @@ void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_eleme
if (kp_fn_mode > 0){ if (kp_fn_mode > 0){
fn_kp_key_found = keys[i][0]; fn_kp_key_found = keys[i][0];
} }
if (joy_fn_mode > 0){
fn_joy_key_found = keys[i][0];
}
} }
else if (buttons[i][2] == RELEASED && else if (buttons[i][2] == RELEASED &&
keys[i][0] != JOY_FN1 &&
keys[i][0] != JOY_FN2 &&
keys[i][0] != KEY_FN1 && keys[i][0] != KEY_FN1 &&
keys[i][0] != KEY_FN2 && keys[i][0] != KEY_FN2) {
keys[i][0] != KEY_FN2L &&
keys[i][0] != KEY_FN2R &&
keys[i][0] != KEY_FN3 &&
keys[i][0] != KEY_FN4) {
// Release all keys linked to this button // Release all keys linked to this button
update_key(keys[i][0], RELEASED); update_key(keys[i][0], RELEASED);
@ -494,9 +242,6 @@ void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_eleme
if (keys[i][0] == fn_kp_key_found){ if (keys[i][0] == fn_kp_key_found){
fn_kp_key_found = 0; fn_kp_key_found = 0;
} }
if (keys[i][0] == fn_joy_key_found){
fn_joy_key_found = 0;
}
// Check to not release the same key one more time // Check to not release the same key one more time
if (keys[i][1] != NO_KEY && keys[i][1] != keys[i][0]) { if (keys[i][1] != NO_KEY && keys[i][1] != keys[i][0]) {
@ -508,21 +253,6 @@ void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_eleme
keys[i][2] != keys[i][1]) { keys[i][2] != keys[i][1]) {
update_key(keys[i][2], RELEASED); update_key(keys[i][2], RELEASED);
} }
// Check to not release the same key one more time
if (keys[i][3] != NO_KEY && keys[i][3] != keys[i][0] &&
keys[i][3] != keys[i][1] &&
keys[i][3] != keys[i][2]) {
update_key(keys[i][3], RELEASED);
}
// Check to not release the same key one more time
if (keys[i][4] != NO_KEY && keys[i][4] != keys[i][0] &&
keys[i][4] != keys[i][1] &&
keys[i][4] != keys[i][2] &&
keys[i][4] != keys[i][3]) {
update_key(keys[i][4], RELEASED);
}
} }
} }
@ -550,7 +280,7 @@ void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_eleme
} else if (buttons[i][2] == RELEASED && keys[i][0] == fn_tap[j].trigger_keycode) { } else if (buttons[i][2] == RELEASED && keys[i][0] == fn_tap[j].trigger_keycode) {
if (fn_tap[j].state == 1) { if (fn_tap[j].state == 1) {
update_key(fn_tap[j].target_keycode, RELEASED); update_key(fn_tap[j].target_keycode, RELEASED);
if ((fn_kp_key_found == 0 && fn_tap[j].kp_fn_mode > 0) || (fn_joy_key_found == 0 && fn_tap[j].joy_fn_mode > 0)) { if (fn_kp_key_found == 0 && fn_tap[j].kp_fn_mode > 0) {
update_key(fn_tap[j].target_keycode, PRESSED); update_key(fn_tap[j].target_keycode, PRESSED);
fn_tap[j].release_timestamp = current_timestamp + fn_tap[j].timeout_time + 10; fn_tap[j].release_timestamp = current_timestamp + fn_tap[j].timeout_time + 10;
fn_tap[j].release_enable = true; fn_tap[j].release_enable = true;
@ -572,104 +302,6 @@ void process_table(byte buttons[][3], const uint16_t keys[][5], int nbr_of_eleme
} }
void update_analog(){
if(joystick_counter == 0){
joystick_x_raw = analogRead(2);
joystick_counter++;
}
else if(joystick_counter == 1){
joystick_y_raw = analogRead(3);
joystick_counter = 0;
if (joystick_calibration_mode == CALIBRATION_OFF){
// ----------------------------------------------------------
// Map X joystick values to proper HID values
// ----------------------------------------------------------
if(joystick_x_raw > (joystick_x_center + DEADZONE_X)){
joystick_x = constrain(map(joystick_x_raw, (joystick_x_center + DEADZONE_X), joystick_x_max, AXIS_CENTER, AXIS_MAX), AXIS_CENTER, AXIS_MAX);
}
else if(joystick_x_raw < (joystick_x_center - DEADZONE_X)){
joystick_x = constrain(map(joystick_x_raw, joystick_x_min, (joystick_x_center - DEADZONE_X), AXIS_MIN, AXIS_CENTER), AXIS_MIN, AXIS_CENTER);
}
else{
joystick_x = AXIS_CENTER;
}
// ----------------------------------------------------------
// Map Y joystick values to proper HID values
// ----------------------------------------------------------
if(joystick_y_raw > (joystick_y_center + DEADZONE_Y)){
joystick_y = constrain(map(joystick_y_raw, (joystick_y_center + DEADZONE_Y), joystick_y_max, AXIS_CENTER, AXIS_MAX), AXIS_CENTER, AXIS_MAX);
}
else if(joystick_y_raw < (joystick_y_center - DEADZONE_Y)){
joystick_y = constrain(map(joystick_y_raw, joystick_y_min, (joystick_y_center - DEADZONE_Y), AXIS_MIN, AXIS_CENTER), AXIS_MIN, AXIS_CENTER);
}
else{
joystick_y = AXIS_CENTER;
}
// ----------------------------------------------------------
// Calculate new axis values after applying exp curve
// ----------------------------------------------------------
// Normal mode
exp_constant = 0.2;
if (joystick_x != AXIS_CENTER){
float joystick_x_float = joystick_x / float(AXIS_MAX);
float joystick_x_exp = exp_constant * (0.5 + 256 * pow((joystick_x_float - 0.5),9)) + (1 - exp_constant) * joystick_x_float;
joystick_x = int(joystick_x_exp * float(HID_AXIS_MAX));
joystick_x = constrain(joystick_x, HID_AXIS_MIN, HID_AXIS_MAX);
}
else{
joystick_x = HID_AXIS_CENTER;
}
if (joystick_y != AXIS_CENTER){
float joystick_y_float = joystick_y / float(AXIS_MAX);
float joystick_y_exp = exp_constant * (0.5 + 256 * pow((joystick_y_float - 0.5),9)) + (1 - exp_constant) * joystick_y_float;
joystick_y = int(joystick_y_exp * float(HID_AXIS_MAX));
joystick_y = constrain(joystick_y, HID_AXIS_MIN, HID_AXIS_MAX);
}
else{
joystick_y = HID_AXIS_CENTER;
}
}
else{
// ----------------------------------------------------------
// Calibration mode.
// ----------------------------------------------------------
joystick_x = HID_AXIS_CENTER;
joystick_y = HID_AXIS_CENTER;
if (joystick_calibration_mode == CALIBRATION_CENTER){
joystick_x_center = joystick_x_raw;
joystick_y_center = joystick_y_raw;
joystick_x_max = joystick_x_center;
joystick_x_min = joystick_x_center;
joystick_y_max = joystick_y_center;
joystick_y_min = joystick_y_center;
}
else if (joystick_calibration_mode == CALIBRATION_MINMAX){
if(joystick_x_raw > joystick_x_max){
joystick_x_max = joystick_x_raw;
}
if(joystick_x_raw < joystick_x_min){
joystick_x_min = joystick_x_raw;
}
if(joystick_y_raw > joystick_y_max){
joystick_y_max = joystick_y_raw;
}
if(joystick_y_raw < joystick_y_min){
joystick_y_min = joystick_y_raw;
}
}
}
}
}
void update_buttons(){ void update_buttons(){
// Scan all buttons // Scan all buttons
@ -682,7 +314,7 @@ void update_buttons(){
if((kp_keypad.key[i].kchar == 1) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){ if((kp_keypad.key[i].kchar == 1) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){
reboot += 1; reboot += 1;
} }
if((kp_keypad.key[i].kchar == 6) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){ if((kp_keypad.key[i].kchar == 12) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){
reboot += 1; reboot += 1;
} }
if((kp_keypad.key[i].kchar == 24) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){ if((kp_keypad.key[i].kchar == 24) && (kp_keypad.key[i].kstate == PRESSED || kp_keypad.key[i].kstate == HOLD)){