From 4f12d559586ab447f6648d6deff9e80c929fbcbe Mon Sep 17 00:00:00 2001 From: Frank Adams Date: Wed, 7 Nov 2018 10:52:50 -0800 Subject: [PATCH] Add files via upload --- .../Teensy LC/Lenovo_T61_KBandTP_LC.ino | 667 ++++++++++++++++++ 1 file changed, 667 insertions(+) create mode 100644 Example_Keyboards/Lenovo_ThinkPad_T61/Teensy LC/Lenovo_T61_KBandTP_LC.ino diff --git a/Example_Keyboards/Lenovo_ThinkPad_T61/Teensy LC/Lenovo_T61_KBandTP_LC.ino b/Example_Keyboards/Lenovo_ThinkPad_T61/Teensy LC/Lenovo_T61_KBandTP_LC.ino new file mode 100644 index 0000000..3b67060 --- /dev/null +++ b/Example_Keyboards/Lenovo_ThinkPad_T61/Teensy LC/Lenovo_T61_KBandTP_LC.ino @@ -0,0 +1,667 @@ +// This software is in the public domain +// It controls a Lenovo ThinkPad T61 Laptop Keyboard and PS/2 Trackpoint using a Teensy LC on +// a daughterboard with a 44 pin FPC connector. The keyboard part number is 42T3177. +// This routine uses the Teensyduino "Micro-Manager Method" to send Normal and Modifier +// keys over USB. Only the volume control multi-media keys are supported by this routine. +// Description of Teensyduino keyboard functions is at www.pjrc.com/teensy/td_keyboard.html +// The PS/2 code for the Trackpoint was originally from https://playground.arduino.cc/uploads/ComponentLib/mouse.txt +// but the interface to the host was changed from RS232 serial to USB using the PJRC Mouse functions. +// A watchdog timer was also added to the "while loops" so the code can't hang if a clock edge is missed. +// +// Revision History +// Initial Release Nov 7, 2018 +// +#define MODIFIERKEY_FN 0x8f // give Fn key a HID code +// Trackpoint signals +#define MDATA 0 // ps/2 data to trackpoint (via BSS138 level translator) +#define MCLK 1 // ps/2 clock to trackpoint (via BSS138 level translator) +// Keyboard LEDs +#define CAPS_LED 13 // includes 715 ohm resistor for 2ma LED +// Set the keyboard row & column size +const byte rows_max = 16; // sets the number of rows in the matrix +const byte cols_max = 8; // sets the number of columns in the matrix +// +// Load the normal key matrix with the Teensyduino key names described at www.pjrc.com/teensy/td_keyboard.html +// A zero indicates no normal key at that location. +// +int normal[rows_max][cols_max] = { + {KEY_TILDE,KEY_1,KEY_Q,KEY_TAB,KEY_A,KEY_ESC,KEY_Z,0}, + {KEY_F1,KEY_2,KEY_W,KEY_CAPS_LOCK,KEY_S,0,KEY_X,0}, + {KEY_F2,KEY_3,KEY_E,KEY_F3,KEY_D,KEY_F4,KEY_C,0}, + {KEY_5,KEY_4,KEY_R,KEY_T,KEY_F,KEY_G,KEY_V,KEY_B}, + {KEY_6,KEY_7,KEY_U,KEY_Y,KEY_J,KEY_H,KEY_M,KEY_N}, + {KEY_EQUAL,KEY_8,KEY_I,KEY_RIGHT_BRACE,KEY_K,KEY_F6,KEY_COMMA,0}, + {KEY_F8,KEY_9,KEY_O,KEY_F7,KEY_L,0,KEY_PERIOD,0}, + {KEY_MINUS,KEY_0,KEY_P,KEY_LEFT_BRACE,KEY_SEMICOLON,KEY_QUOTE,0,KEY_SLASH}, + {KEY_F9,KEY_F10,0,KEY_BACKSPACE,KEY_BACKSLASH,KEY_F5,KEY_ENTER,KEY_SPACE}, + {KEY_INSERT,KEY_F12,0,0,0,0,0,KEY_RIGHT}, + {KEY_DELETE,KEY_F11,0,0,0,0,0,KEY_DOWN}, + {KEY_PAGE_UP,KEY_PAGE_DOWN,0,0,KEY_MENU,0,0,0}, + {KEY_HOME,KEY_END,0,0,0,KEY_UP,KEY_PAUSE,KEY_LEFT}, + {0,KEY_PRINTSCREEN,KEY_SCROLL_LOCK,0,0,0,0,0}, + {0,0,0,0,0,0,0,0}, + {0,0,0,0,0,0,0,0} +}; +// Load the modifier key matrix with key names at the correct row-column location. +// A zero indicates no modifier key at that location. +int modifier[rows_max][cols_max] = { + {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}, + {0,0,0,0,MODIFIERKEY_FN,0,0,0}, + {0,0,0,0,0,0,0,0}, + {0,0,MODIFIERKEY_GUI,0,0,0,0,0}, + {0,0,0,0,0,0,0,0}, + {0,0,0,0,0,MODIFIERKEY_LEFT_ALT,0,MODIFIERKEY_RIGHT_ALT}, + {0,0,0,MODIFIERKEY_LEFT_SHIFT,0,0,MODIFIERKEY_RIGHT_SHIFT,0}, + {MODIFIERKEY_LEFT_CTRL,0,0,0,0,0,MODIFIERKEY_RIGHT_CTRL,0} +}; +// Load the media key matrix with key names at the correct row-column location. +// A zero indicates no media key at that location. +int media[rows_max][cols_max] = { + {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}, + {0,0,0,0,0,0,0,0}, + {0,0,KEY_MEDIA_VOLUME_INC,KEY_MEDIA_VOLUME_DEC,KEY_MEDIA_MUTE,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} +}; +// Initialize the old_key matrix with one's. +// 1 = key not pressed, 0 = key is pressed +boolean old_key[rows_max][cols_max] = { + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1}, + {1,1,1,1,1,1,1,1} +}; +// +// Define the Teensy 3.2 I/O numbers +// +// Row FPC pin # 22,18,14,10,02,04,08,12,06,20,16,24,28,32,26,30 +// Teensy I/O # 15,20,19,18,16,08,07,06,17,09,05,10,11,12,14,26 +int Row_IO[rows_max] = {15,20,19,18,16,8,7,6,17,9,5,10,11,12,14,26}; // Teensy LC I/O numbers for rows +// +// Column FPC pin # 05,13,09,07,11,03,15,17 +// Teensy I/O # 21,23,22,25,24,04,03,02 +int Col_IO[cols_max] = {21,23,22,25,24,4,3,2}; // Teensy LC I/O numbers for columns +// +// Declare variables that will be used by functions +boolean trackpoint_error = LOW; // sent high when touch pad routine times out +boolean slots_full = LOW; // Goes high when slots 1 thru 6 contain normal keys +// slot 1 thru slot 6 hold the normal key values to be sent over USB. +int slot1 = 0; //value of 0 means the slot is empty and can be used. +int slot2 = 0; +int slot3 = 0; +int slot4 = 0; +int slot5 = 0; +int slot6 = 0; +// +int mod_shift_l = 0; // These variables are sent over USB as modifier keys. +int mod_shift_r = 0; // Each is either set to 0 or MODIFIER_ ... +int mod_ctrl_l = 0; +int mod_ctrl_r = 0; +int mod_alt_l = 0; +int mod_alt_r = 0; +int mod_gui = 0; +// +// *****************Functions for Trackpoint*************************** +// Function to send the trackpoint a command +void trackpoint_write(char data) +{ + char i; + char parity = 1; + // put pins in output mode + go_z(MDATA); + go_z(MCLK); + elapsedMillis watchdog; // set watchdog to zero + delayMicroseconds(300); + go_0(MCLK); + delayMicroseconds(300); + go_0(MDATA); + delayMicroseconds(10); + // start bit + go_z(MCLK); + // wait for trackpoint to take control of clock) + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // clock is low, and we are clear to send data + for (i=0; i < 8; i++) { + if (data & 0x01) { + go_z(MDATA); + } + else { + go_0(MDATA); + } + // wait for clock cycle + while (digitalRead(MCLK) == LOW) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + parity = parity ^ (data & 0x01); + data = data >> 1; + } + // parity + if (parity) { + go_z(MDATA); + } + else { + go_0(MDATA); + } + // wait for clock cycle + while (digitalRead(MCLK) == LOW) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // stop bit + go_z(MDATA); + delayMicroseconds(50); + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // wait for trackpoint to switch modes + while ((digitalRead(MCLK) == LOW) || (digitalRead(MDATA) == LOW)) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // put a hold on the incoming data. + go_0(MCLK); +} + +// +// Function to get a byte of data from the trackpoint +// +char trackpoint_read(void) +{ + char data = 0x00; + int i; + char bity = 0x01; + // start the clock + elapsedMillis watchdog; // set watchdog to zero + go_z(MCLK); + go_z(MDATA); + delayMicroseconds(50); + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + delayMicroseconds(5); // wait for clock ring to settle + while (digitalRead(MCLK) == LOW) { // eat start bit + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + for (i=0; i < 8; i++) { + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + if (digitalRead(MDATA) == HIGH) { + data = data | bity; + } + while (digitalRead(MCLK) == LOW) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + bity = bity << 1; + } + // ignore parity bit + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + while (digitalRead(MCLK) == LOW) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // eat stop bit + while (digitalRead(MCLK) == HIGH) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + while (digitalRead(MCLK) == LOW) { + if (watchdog >= 200) { //check for infinite loop + trackpoint_error = HIGH; // set error flag + break; + } + } + // put a hold on the incoming data. + go_0(MCLK); + return data; +} + +void trackpoint_init() +{ + trackpoint_error = LOW; // start with no error + go_z(MCLK); // float the clock and data to trackpoint + go_z(MDATA); + delay(1000); // wait 1 second to let power on reset to release + // Sending reset command to trackpoint + trackpoint_write(0xff); + trackpoint_read(); // ack byte + // Read ack byte + trackpoint_read(); // blank + trackpoint_read(); // blank + // Sending remote mode code so the trackpoint will send data only when polled + trackpoint_write(0xf0); // remote mode + trackpoint_read(); // Read ack byte + delayMicroseconds(100); +} +// +// *****************Functions for Keyboard***************************** +// Function to load the key name into the first available slot +void load_slot(int key) { + if (!slot1) { + slot1 = key; + } + else if (!slot2) { + slot2 = key; + } + else if (!slot3) { + slot3 = key; + } + else if (!slot4) { + slot4 = key; + } + else if (!slot5) { + slot5 = key; + } + else if (!slot6) { + slot6 = key; + } + if (!slot1 || !slot2 || !slot3 || !slot4 || !slot5 || !slot6) { + slots_full = LOW; // slots are not full + } + else { + slots_full = HIGH; // slots are full + } +} +// +// Function to clear the slot that contains the key name +void clear_slot(int key) { + if (slot1 == key) { + slot1 = 0; + } + else if (slot2 == key) { + slot2 = 0; + } + else if (slot3 == key) { + slot3 = 0; + } + else if (slot4 == key) { + slot4 = 0; + } + else if (slot5 == key) { + slot5 = 0; + } + else if (slot6 == key) { + slot6 = 0; + } + slots_full = LOW; +} +// +// Function to load the modifier key name into the appropriate mod variable +void load_mod(int m_key) { + if (m_key == MODIFIERKEY_LEFT_SHIFT) { + mod_shift_l = m_key; + } + else if (m_key == MODIFIERKEY_RIGHT_SHIFT) { + mod_shift_r = m_key; + } + else if (m_key == MODIFIERKEY_LEFT_CTRL) { + mod_ctrl_l = m_key; + } + else if (m_key == MODIFIERKEY_RIGHT_CTRL) { + mod_ctrl_r = m_key; + } + else if (m_key == MODIFIERKEY_LEFT_ALT) { + mod_alt_l = m_key; + } + else if (m_key == MODIFIERKEY_RIGHT_ALT) { + mod_alt_r = m_key; + } + else if (m_key == MODIFIERKEY_GUI) { + mod_gui = m_key; + } +} +// +// Function to load 0 into the appropriate mod variable +void clear_mod(int m_key) { + if (m_key == MODIFIERKEY_LEFT_SHIFT) { + mod_shift_l = 0; + } + else if (m_key == MODIFIERKEY_RIGHT_SHIFT) { + mod_shift_r = 0; + } + else if (m_key == MODIFIERKEY_LEFT_CTRL) { + mod_ctrl_l = 0; + } + else if (m_key == MODIFIERKEY_RIGHT_CTRL) { + mod_ctrl_r = 0; + } + else if (m_key == MODIFIERKEY_LEFT_ALT) { + mod_alt_l = 0; + } + else if (m_key == MODIFIERKEY_RIGHT_ALT) { + mod_alt_r = 0; + } + else if (m_key == MODIFIERKEY_GUI) { + mod_gui = 0; + } +} +// +// Function to send the modifier keys over usb +void send_mod() { + Keyboard.set_modifier(mod_shift_l | mod_shift_r | mod_ctrl_l | mod_ctrl_r | mod_alt_l | mod_alt_r | mod_gui); + Keyboard.send_now(); +} +// +// Function to send the normal keys in the 6 slots over usb +void send_normals() { + Keyboard.set_key1(slot1); + Keyboard.set_key2(slot2); + Keyboard.set_key3(slot3); + Keyboard.set_key4(slot4); + Keyboard.set_key5(slot5); + Keyboard.set_key6(slot6); + Keyboard.send_now(); +} +// **************Functions common to keyboard and trackpoint************************** +// +// Function to set a pin to high impedance (acts like open drain output) +void go_z(int pin) +{ + pinMode(pin, INPUT); + digitalWrite(pin, HIGH); +} +// +// Function to set a pin as an input with a pullup +void go_pu(int pin) +{ + pinMode(pin, INPUT_PULLUP); + digitalWrite(pin, HIGH); +} +// +// Function to send a pin to a logic low +void go_0(int pin) +{ + pinMode(pin, OUTPUT); + digitalWrite(pin, LOW); +} +// +// Function to send a pin to a logic high +void go_1(int pin) +{ + pinMode(pin, OUTPUT); + digitalWrite(pin, HIGH); +} +// +//************************************Setup******************************************* +void setup() { +// ************trackpoint setup + trackpoint_init(); // reset trackpoint, then set it's resolution and put it in remote mode + if (trackpoint_error) { + trackpoint_init(); // try one more time to initialize the trackpoint + } +// ************keyboard setup + for (int a = 0; a < cols_max; a++) { // loop thru all column pins + go_pu(Col_IO[a]); // set each column pin as an input with a pullup + } +// + for (int b = 0; b < rows_max; b++) { // loop thru all row pins + go_z(Row_IO[b]); // set each row pin as a floating output + } +// +} +// +// *******declare and initialize trackpoint variables +char mstat; // trackpoint status reg = Y overflow, X overflow, Y sign bit, X sign bit, Always 1, Middle Btn, Right Btn, Left Btn +char mx; // trackpoint x movement = 8 data bits. The sign bit is in the status register to + // make a 9 bit 2's complement value. Left to right on the trackpoint gives a positive value. +char my; // trackpoint y movement also 8 bits plus sign. trackpoint movement away from the user gives a positive value. +boolean over_flow; // set if x or y movement values are bad due to overflow +boolean left_button = 0; // on/off variable for left button = bit 0 of mstat +boolean right_button = 0; // on/off variable for right button = bit 1 of mstat +boolean middle_button = 0; // on/off variable for middle button = bit 2 of mstat +boolean old_left_button = 0; // on/off variable for left button status the previous polling cycle +boolean old_right_button = 0; // on/off variable for right button status the previous polling cycle +boolean old_middle_button = 0; // on/off variable for middle button status the previous polling cycle +boolean button_change = 0; // Active high, shows when any trackpoint button has changed since last polling cycle +// **********declare and initialize keyboard variables +boolean Fn_pressed = HIGH; // Initialize Fn key to HIGH = "not pressed" +extern volatile uint8_t keyboard_leds; // 8 bits sent from Host to Teensy that give keyboard LED status. +// +//*********************************Main Loop******************************************* +// +void loop() { +// *************Keyboard Main************** +// Scan keyboard matrix with an outer loop that drives each row low and an inner loop that reads every column (with pull ups). +// The routine looks at each key's present state (by reading the column input pin) and also the previous state from the last scan +// that was 30msec ago. The status of a key that was just pressed or just released is sent over USB and the state is saved in the old_key matrix. +// The keyboard keys will read as logic low if they are pressed (negative logic). +// The old_key matrix also uses negative logic (low=pressed). +// + for (int x = 0; x < rows_max; x++) { // loop thru the rows + go_0(Row_IO[x]); // Activate Row (send it low) + delayMicroseconds(10); // give the row time to go low and settle out + for (int y = 0; y < cols_max; y++) { // loop thru the columns +// **********Modifier keys + if (modifier[x][y] != 0) { // check if modifier key exists at this location in the array (a non-zero value) + if (!digitalRead(Col_IO[y]) && (old_key[x][y])) { // Read column to see if key is low (pressed) and was previously not pressed + if (modifier[x][y] != MODIFIERKEY_FN) { // Exclude Fn modifier key + load_mod(modifier[x][y]); // function reads which modifier key is pressed and loads it into the appropriate mod_... variable + send_mod(); // function sends the state of all modifier keys over usb including the one that just got pressed + old_key[x][y] = LOW; // Save state of key as "pressed" + } + else { + Fn_pressed = LOW; // Fn status variable is active low + old_key[x][y] = LOW; // old_key state is "pressed" (active low) + } + } + else if (digitalRead(Col_IO[y]) && (!old_key[x][y])) { //check if key is not pressed and was previously pressed + if (modifier[x][y] != MODIFIERKEY_FN) { // Exclude Fn modifier key + clear_mod(modifier[x][y]); // function reads which modifier key was released and loads 0 into the appropriate mod_... variable + send_mod(); // function sends all mod's over usb including the one that just released + old_key[x][y] = HIGH; // Save state of key as "not pressed" + } + else { + Fn_pressed = HIGH; // Fn is no longer active + old_key[x][y] = HIGH; // old_key state is "not pressed" + } + } + } +// ***********end of modifier section +// +// ***********Normal keys section + else if (normal[x][y] != 0) { // check if normal key exists at this location in the array (a non-zero value) + if (!digitalRead(Col_IO[y]) && (old_key[x][y])) { // check if key is pressed and was not previously pressed + old_key[x][y] = LOW; // Save state of key as "pressed" + if ((normal[x][y] == KEY_SCROLL_LOCK) && (!Fn_pressed)) { // check for special case of Num Lock Key + load_slot(KEY_NUM_LOCK); // update first available slot with Num Lock instead of Scroll Lock + send_normals(); // send all slots over USB including the Num Lock Key that just got pressed + } + else { + load_slot(normal[x][y]); //update first available slot with normal key name + send_normals(); // send all slots over USB including the key that just got pressed + } + } + else if (digitalRead(Col_IO[y]) && (!old_key[x][y])) { //check if key is not pressed, but was previously pressed + old_key[x][y] = HIGH; // Save state of key as "not pressed" + if ((normal[x][y] == KEY_SCROLL_LOCK) && (!Fn_pressed)) { // check for special case of Num Lock Key + clear_slot(KEY_NUM_LOCK); // clear the slot that contains Num Lock + send_normals(); // send all slots over USB including the Num Lock key + } + else { + clear_slot(normal[x][y]); //clear the slot that contains the normal key name + send_normals(); // send all slots over USB including the key that was just released + } + } + } +// **************end of normal section +// +// *************Volume key section. Note PJRC states that volume up, down, & mute should be sent with Keyboard.press function. + else if (media[x][y] != 0) { // check if any volume control key exists at this location in the array (a non-zero value) + if (!digitalRead(Col_IO[y]) && (old_key[x][y])) { // check if key is pressed and was not previously pressed + old_key[x][y] = LOW; // Save state of key as "pressed" + Keyboard.press(media[x][y]); // send volume key press + } + else if (digitalRead(Col_IO[y]) && (!old_key[x][y])) { //check if key is not pressed, but was previously pressed + old_key[x][y] = HIGH; // Save state of key as "not pressed" + Keyboard.release(media[x][y]); // send volume key release + } + } +// ***************end of volume section + } + go_z(Row_IO[x]); // De-activate Row (send it to hi-z) + } +// +// **********keyboard scan complete +// +// ****************************Trackpoint Routine********************************* +// +// poll the trackpoint for new movement data + over_flow = 0; // assume no overflow until status is received + trackpoint_error = LOW; // start with no error + trackpoint_write(0xeb); // request data + trackpoint_read(); // ignore ack + mstat = trackpoint_read(); // save into status variable + mx = trackpoint_read(); // save into x variable + my = trackpoint_read(); // save into y variable + if (((0x80 & mstat) == 0x80) || ((0x40 & mstat) == 0x40)) { // x or y overflow bits set? + over_flow = 1; // set the overflow flag + } +// change the x data from 9 bit to 8 bit 2's complement + mx = mx >> 1; // convert to 7 bits of data by dividing by 2 + mx = mx & 0x7f; // don't allow sign extension + if ((0x10 & mstat) == 0x10) { // move the sign into + mx = 0x80 | mx; // the 8th bit position + } +// change the y data from 9 bit to 8 bit 2's complement and then take the 2's complement +// because y movement on ps/2 format is opposite of touchpad.move function + my = my >> 1; // convert to 7 bits of data by dividing by 2 + my = my & 0x7f; // don't allow sign extension + if ((0x20 & mstat) == 0x20) { // move the sign into + my = 0x80 | my; // the 8th bit position + } + my = (~my + 0x01); // change the sign of y data by taking the 2's complement (invert and add 1) +// zero out mx and my if over_flow or trackpoint_error is set + if ((over_flow) || (trackpoint_error)) { + mx = 0x00; // data is garbage so zero it out + my = 0x00; + } +// send the x and y data back via usb if either one is non-zero + if ((mx != 0x00) || (my != 0x00)) { + Mouse.move(mx,my); + } +// +// send the trackpoint left and right button status over usb if no error + if (!trackpoint_error) { + if ((0x01 & mstat) == 0x01) { // if left button set + left_button = 1; + } + else { // clear left button + left_button = 0; + } + if ((0x02 & mstat) == 0x02) { // if right button set + right_button = 1; + } + else { // clear right button + right_button = 0; + } + if ((0x04 & mstat) == 0x04) { // if middle button set + middle_button = 1; + } + else { // clear middle button + middle_button = 0; + } +// Determine if any buttons have changed since last polling cycle + button_change = ((left_button ^ old_left_button) | (right_button ^ old_right_button) | (middle_button ^ old_middle_button)); +// Don't send button status if there's no change since last time. + if (button_change) { + Mouse.set_buttons(left_button, middle_button, right_button); // send button status + } + old_left_button = left_button; // remember new button status for next polling cycle + old_right_button = right_button; + old_middle_button = middle_button; + } +// **************************************End of trackpoint routine*********************************** +// +// *******keyboard LEDs +// Turn on or off the LED for Caps Lock based on bit 1 from the keyboard_leds variable controlled by the USB host computer +// + if (keyboard_leds & 1<<1) { // mask off all bits but D1 and test if set + go_1(CAPS_LED); // turn on the Caps Lock LED + } + else { + go_0(CAPS_LED); // turn off the Caps Lock LED + } +// +// ****************End of main loop +// + delay(24); // The overall keyboard/trackpoint scanning rate was measured at 30ms +}