]> git.donarmstrong.com Git - kiibohd-controller.git/blobdiff - Macro/PartialMap/macro.c
Adding variable width state variable width.
[kiibohd-controller.git] / Macro / PartialMap / macro.c
index 38d918e56135eb64824362f977be98e6bb22f200..b81c76a267d64c93b185c0af20c96879808e09ab 100644 (file)
@@ -28,7 +28,8 @@
 // Keymaps
 #include "usb_hid.h"
 #include <defaultMap.h>
-#include "generatedKeymap.h" // TODO Use actual generated version
+#include "templateKeymap.h" // TODO Use actual generated version
+//#include "generatedKeymap.h" // TODO Use actual generated version
 
 // Local Includes
 #include "macro.h"
@@ -39,6 +40,7 @@
 
 void cliFunc_capList   ( char* args );
 void cliFunc_capSelect ( char* args );
+void cliFunc_keyHold   ( char* args );
 void cliFunc_keyPress  ( char* args );
 void cliFunc_keyRelease( char* args );
 void cliFunc_layerList ( char* args );
@@ -55,12 +57,13 @@ void cliFunc_macroStep ( char* args );
 
 // Bit positions are important, passes (correct key) always trump incorrect key votes
 typedef enum TriggerMacroVote {
-       TriggerMacroVote_Release      = 0x8, // Correct key
-       TriggerMacroVote_PassRelease  = 0xC, // Correct key (both pass and release)
-       TriggerMacroVote_Pass         = 0x4, // Correct key
-       TriggerMacroVote_DoNothing    = 0x2, // Incorrect key
-       TriggerMacroVote_Fail         = 0x1, // Incorrect key
-       TriggerMacroVote_Invalid      = 0x0, // Invalid state
+       TriggerMacroVote_Release          = 0x10, // Correct key
+       TriggerMacroVote_PassRelease      = 0x18, // Correct key (both pass and release)
+       TriggerMacroVote_Pass             = 0x8,  // Correct key
+       TriggerMacroVote_DoNothingRelease = 0x4,  // Incorrect key
+       TriggerMacroVote_DoNothing        = 0x2,  // Incorrect key
+       TriggerMacroVote_Fail             = 0x1,  // Incorrect key
+       TriggerMacroVote_Invalid          = 0x0,  // Invalid state
 } TriggerMacroVote;
 
 typedef enum TriggerMacroEval {
@@ -80,12 +83,13 @@ typedef enum ResultMacroEval {
 // ----- Variables -----
 
 // Macro Module command dictionary
-char*       macroCLIDictName = "Macro Module Commands";
-CLIDictItem macroCLIDict[] = {
+const char macroCLIDictName[] = "Macro Module Commands";
+const CLIDictItem macroCLIDict[] = {
        { "capList",     "Prints an indexed list of all non USB keycode capabilities.", cliFunc_capList },
        { "capSelect",   "Triggers the specified capabilities. First two args are state and stateType." NL "\t\t\033[35mK11\033[0m Keyboard Capability 0x0B", cliFunc_capSelect },
-       { "keyPress",    "Send key-presses to the macro module. Held until released. Duplicates have undefined behaviour." NL "\t\t\033[35mS10\033[0m Scancode 0x0A", cliFunc_keyPress },
-       { "keyRelease",  "Release a key-press from the macro module. Duplicates have undefined behaviour." NL "\t\t\033[35mS10\033[0m Scancode 0x0A", cliFunc_keyRelease },
+       { "keyHold",     "Send key-hold events to the macro module. Duplicates have undefined behaviour." NL "\t\t\033[35mS10\033[0m Scancode 0x0A", cliFunc_keyHold },
+       { "keyPress",    "Send key-press events to the macro module. Duplicates have undefined behaviour." NL "\t\t\033[35mS10\033[0m Scancode 0x0A", cliFunc_keyPress },
+       { "keyRelease",  "Send key-release event to macro module. Duplicates have undefined behaviour." NL "\t\t\033[35mS10\033[0m Scancode 0x0A", cliFunc_keyRelease },
        { "layerList",   "List available layers.", cliFunc_layerList },
        { "layerState",  "Modify specified indexed layer state <layer> <state byte>." NL "\t\t\033[35mL2\033[0m Indexed Layer 0x02" NL "\t\t0 Off, 1 Shift, 2 Latch, 4 Lock States", cliFunc_layerState },
        { "macroDebug",  "Disables/Enables sending USB keycodes to the Output Module and prints U/K codes.", cliFunc_macroDebug },
@@ -121,7 +125,7 @@ unsigned int macroTriggerMacroPendingListSize = 0;
 
 // Layer Index Stack
 //  * When modifying layer state and the state is non-0x0, the stack must be adjusted
-unsigned int macroLayerIndexStack[ LayerNum ] = { 0 };
+unsigned int macroLayerIndexStack[ LayerNum + 1 ] = { 0 };
 unsigned int macroLayerIndexStackSize = 0;
 
 // Pending Result Macro Index List
@@ -133,24 +137,9 @@ unsigned int macroResultMacroPendingListSize = 0;
 
 // ----- Capabilities -----
 
-// Modifies the specified Layer control byte
-// Argument #1: Layer Index -> unsigned int
-// Argument #2: Toggle byte -> uint8_t
-void Macro_layerStateToggle_capability( uint8_t state, uint8_t stateType, uint8_t *args )
+// Sets the given layer with the specified layerState
+void Macro_layerState( uint8_t state, uint8_t stateType, uint16_t layer, uint8_t layerState )
 {
-       // Display capability name
-       if ( stateType == 0xFF && state == 0xFF )
-       {
-               print("Macro_layerState(layerIndex,toggleByte)");
-               return;
-       }
-
-       // Get layer index from arguments
-       unsigned int layer = (unsigned int)(&args[0]);
-
-       // Get layer toggle byte
-       uint8_t toggleByte = args[ sizeof(unsigned int) ];
-
        // Is layer in the LayerIndexStack?
        uint8_t inLayerIndexStack = 0;
        unsigned int stackItem = 0;
@@ -168,15 +157,15 @@ void Macro_layerStateToggle_capability( uint8_t state, uint8_t stateType, uint8_
        }
 
        // Toggle Layer State Byte
-       if ( LayerIndex[ layer ].state & toggleByte )
+       if ( LayerIndex[ layer ].state & layerState )
        {
                // Unset
-               LayerIndex[ layer ].state &= ~toggleByte;
+               LayerIndex[ layer ].state &= ~layerState;
        }
        else
        {
                // Set
-               LayerIndex[ layer ].state |= toggleByte;
+               LayerIndex[ layer ].state |= layerState;
        }
 
        // If the layer was not in the LayerIndexStack add it
@@ -201,13 +190,115 @@ void Macro_layerStateToggle_capability( uint8_t state, uint8_t stateType, uint8_
        }
 }
 
+// Modifies the specified Layer control byte
+// Argument #1: Layer Index -> uint16_t
+// Argument #2: Layer State -> uint8_t
+void Macro_layerState_capability( uint8_t state, uint8_t stateType, uint8_t *args )
+{
+       // Display capability name
+       if ( stateType == 0xFF && state == 0xFF )
+       {
+               print("Macro_layerState(layerIndex,layerState)");
+               return;
+       }
+
+       // Only use capability on press or release
+       // TODO Analog
+       // XXX This may cause issues, might be better to implement state table here to decide -HaaTa
+       if ( stateType == 0x00 && state == 0x02 ) // Hold condition
+               return;
+
+       // Get layer index from arguments
+       // Cast pointer to uint8_t to unsigned int then access that memory location
+       uint16_t layer = *(uint16_t*)(&args[0]);
+
+       // Get layer toggle byte
+       uint8_t layerState = args[ sizeof(uint16_t) ];
+
+       Macro_layerState( state, stateType, layer, layerState );
+}
+
+
+// Latches given layer
+// Argument #1: Layer Index -> uint16_t
+void Macro_layerLatch_capability( uint8_t state, uint8_t stateType, uint8_t *args )
+{
+       // Display capability name
+       if ( stateType == 0xFF && state == 0xFF )
+       {
+               print("Macro_layerLatch(layerIndex)");
+               return;
+       }
+
+       // Only use capability on press
+       // TODO Analog
+       // XXX To make sense, this code be on press or release. Or it could even be a sticky shift (why? dunno) -HaaTa
+       if ( stateType == 0x00 && state != 0x01 ) // All normal key conditions except press
+               return;
+
+       // Get layer index from arguments
+       // Cast pointer to uint8_t to unsigned int then access that memory location
+       uint16_t layer = *(uint16_t*)(&args[0]);
+
+       Macro_layerState( state, stateType, layer, 0x02 );
+}
+
+
+// Locks given layer
+// Argument #1: Layer Index -> uint16_t
+void Macro_layerLock_capability( uint8_t state, uint8_t stateType, uint8_t *args )
+{
+       // Display capability name
+       if ( stateType == 0xFF && state == 0xFF )
+       {
+               print("Macro_layerLock(layerIndex)");
+               return;
+       }
+
+       // Only use capability on press
+       // TODO Analog
+       // XXX Could also be on release, but that's sorta dumb -HaaTa
+       if ( stateType == 0x00 && state != 0x01 ) // All normal key conditions except press
+               return;
+
+       // Get layer index from arguments
+       // Cast pointer to uint8_t to unsigned int then access that memory location
+       uint16_t layer = *(uint16_t*)(&args[0]);
+
+       Macro_layerState( state, stateType, layer, 0x04 );
+}
+
+
+// Shifts given layer
+// Argument #1: Layer Index -> uint16_t
+void Macro_layerShift_capability( uint8_t state, uint8_t stateType, uint8_t *args )
+{
+       // Display capability name
+       if ( stateType == 0xFF && state == 0xFF )
+       {
+               print("Macro_layerShift(layerIndex)");
+               return;
+       }
+
+       // Only use capability on press or release
+       // TODO Analog
+       if ( stateType == 0x00 && ( state == 0x00 || state == 0x02 ) ) // Only pass press or release conditions
+               return;
+
+       // Get layer index from arguments
+       // Cast pointer to uint8_t to unsigned int then access that memory location
+       uint16_t layer = *(uint16_t*)(&args[0]);
+
+       Macro_layerState( state, stateType, layer, 0x01 );
+}
+
 
 
 // ----- Functions -----
 
 // Looks up the trigger list for the given scan code (from the active layer)
 // NOTE: Calling function must handle the NULL pointer case
-unsigned int *Macro_layerLookup( uint8_t scanCode )
+nat_ptr_t *Macro_layerLookup( uint8_t scanCode )
 {
        // If no trigger macro is defined at the given layer, fallthrough to the next layer
        for ( unsigned int layerIndex = 0; layerIndex < macroLayerIndexStackSize; layerIndex++ )
@@ -229,7 +320,7 @@ unsigned int *Macro_layerLookup( uint8_t scanCode )
                if ( (layer->state & 0x01) ^ (latch>>1) ^ ((layer->state & 0x04)>>2) )
                {
                        // Lookup layer
-                       unsigned int **map = layer->triggerMap;
+                       nat_ptr_t **map = (nat_ptr_t**)layer->triggerMap;
 
                        // Determine if layer has key defined
                        if ( map != 0 && *map[ scanCode ] != 0 )
@@ -238,7 +329,7 @@ unsigned int *Macro_layerLookup( uint8_t scanCode )
        }
 
        // Do lookup on default layer
-       unsigned int **map = LayerIndex[0].triggerMap;
+       nat_ptr_t **map = (nat_ptr_t**)LayerIndex[0].triggerMap;
 
        // Determine if layer has key defined
        if ( map == 0 && *map[ scanCode ] == 0 )
@@ -314,8 +405,11 @@ inline void Macro_ledState( uint8_t ledCode, uint8_t state )
 
 // Append result macro to pending list, checking for duplicates
 // Do nothing if duplicate
-inline void Macro_appendResultMacroToPendingList( unsigned int resultMacroIndex )
+inline void Macro_appendResultMacroToPendingList( TriggerMacro *triggerMacro )
 {
+       // Lookup result macro index
+       unsigned int resultMacroIndex = triggerMacro->result;
+
        // Iterate through result macro pending list, making sure this macro hasn't been added yet
        for ( unsigned int macro = 0; macro < macroResultMacroPendingListSize; macro++ )
        {
@@ -326,6 +420,29 @@ inline void Macro_appendResultMacroToPendingList( unsigned int resultMacroIndex
 
        // No duplicates found, add to pending list
        macroResultMacroPendingList[ macroResultMacroPendingListSize++ ] = resultMacroIndex;
+
+       // Lookup scanCode of the last key in the last combo
+       unsigned int pos = 0;
+       for ( uint8_t comboLength = triggerMacro->guide[0]; comboLength > 0; )
+       {
+               pos += TriggerGuideSize * comboLength + 1;
+               comboLength = triggerMacro->guide[ pos ];
+       }
+
+       uint8_t scanCode = ((TriggerGuide*)&triggerMacro->guide[ pos - TriggerGuideSize ])->scanCode;
+
+       // Lookup scanCode in buffer list for the current state and stateType
+       for ( uint8_t keyIndex = 0; keyIndex < macroTriggerListBufferSize; keyIndex++ )
+       {
+               if ( macroTriggerListBuffer[ keyIndex ].scanCode == scanCode )
+               {
+                       ResultMacroList[ resultMacroIndex ].state     = macroTriggerListBuffer[ keyIndex ].state;
+                       ResultMacroList[ resultMacroIndex ].stateType = macroTriggerListBuffer[ keyIndex ].type;
+               }
+       }
+
+       // Reset the macro position
+       ResultMacroList[ resultMacroIndex ].pos = 0;
 }
 
 
@@ -333,14 +450,78 @@ inline void Macro_appendResultMacroToPendingList( unsigned int resultMacroIndex
 inline uint8_t Macro_isLongResultMacro( ResultMacro *macro )
 {
        // Check the second sequence combo length
-       // If non-zero return 1 (long sequence)
+       // If non-zero return non-zero (long sequence)
        // 0 otherwise (short sequence)
-       return macro->guide[ macro->guide[0] * ResultGuideSize( (ResultGuide*)macro->guide ) ] > 0 ? 1 : 0;
+       unsigned int position = 1;
+       for ( unsigned int result = 0; result < macro->guide[0]; result++ )
+               position += ResultGuideSize( (ResultGuide*)&macro->guide[ position ] );
+       return macro->guide[ position ];
+}
+
+
+// Determine if long TriggerMacro (more than 1 sequence element)
+inline uint8_t Macro_isLongTriggerMacro( TriggerMacro *macro )
+{
+       // Check the second sequence combo length
+       // If non-zero return non-zero (long sequence)
+       // 0 otherwise (short sequence)
+       return macro->guide[ macro->guide[0] * TriggerGuideSize + 1 ];
+}
+
+
+// Votes on the given key vs. guide, short macros
+inline TriggerMacroVote Macro_evalShortTriggerMacroVote( TriggerGuide *key, TriggerGuide *guide )
+{
+       // Depending on key type
+       switch ( guide->type )
+       {
+       // Normal State Type
+       case 0x00:
+               // For short TriggerMacros completely ignore incorrect keys
+               if ( guide->scanCode == key->scanCode )
+               {
+                       switch ( key->state )
+                       {
+                       // Correct key, pressed, possible passing
+                       case 0x01:
+                               return TriggerMacroVote_Pass;
+
+                       // Correct key, held, possible passing or release
+                       case 0x02:
+                               return TriggerMacroVote_PassRelease;
+
+                       // Correct key, released, possible release
+                       case 0x03:
+                               return TriggerMacroVote_Release;
+                       }
+               }
+
+               return TriggerMacroVote_DoNothing;
+
+       // LED State Type
+       case 0x01:
+               erro_print("LED State Type - Not implemented...");
+               break;
+
+       // Analog State Type
+       case 0x02:
+               erro_print("Analog State Type - Not implemented...");
+               break;
+
+       // Invalid State Type
+       default:
+               erro_print("Invalid State Type. This is a bug.");
+               break;
+       }
+
+       // XXX Shouldn't reach here
+       return TriggerMacroVote_Invalid;
 }
 
 
-// Votes on the given key vs. guide
-inline TriggerMacroVote Macro_evalTriggerMacroVote( TriggerGuide *key, TriggerGuide *guide )
+// Votes on the given key vs. guide, long macros
+// A long macro is defined as a guide with more than 1 combo
+inline TriggerMacroVote Macro_evalLongTriggerMacroVote( TriggerGuide *key, TriggerGuide *guide )
 {
        // Depending on key type
        switch ( guide->type )
@@ -357,10 +538,13 @@ inline TriggerMacroVote Macro_evalTriggerMacroVote( TriggerGuide *key, TriggerGu
                        case 0x01:
                                return TriggerMacroVote_Fail;
 
-                       // Wrong key, held or released, do not pass (no effect)
+                       // Wrong key, held, do not pass (no effect)
                        case 0x02:
-                       case 0x03:
                                return TriggerMacroVote_DoNothing;
+
+                       // Wrong key released, fail out if pos == 0
+                       case 0x03:
+                               return TriggerMacroVote_DoNothing | TriggerMacroVote_DoNothingRelease;
                        }
                }
 
@@ -416,14 +600,14 @@ inline TriggerMacroEval Macro_evalTriggerMacro( unsigned int triggerMacroIndex )
        if ( macro->state == TriggerMacro_Release )
        {
                macro->state = TriggerMacro_Waiting;
-               macro->pos = macro->pos + macro->guide[ macro->pos ] * TriggerGuideSize;
+               macro->pos = macro->pos + macro->guide[ macro->pos ] * TriggerGuideSize + 1;
        }
 
        // Current Macro position
        unsigned int pos = macro->pos;
 
        // Length of the combo being processed
-       uint8_t comboLength = macro->guide[ pos ];
+       uint8_t comboLength = macro->guide[ pos ] * TriggerGuideSize;
 
        // If no combo items are left, remove the TriggerMacro from the pending list
        if ( comboLength == 0 )
@@ -431,7 +615,10 @@ inline TriggerMacroEval Macro_evalTriggerMacro( unsigned int triggerMacroIndex )
                return TriggerMacroEval_Remove;
        }
 
-       // Iterate through the key buffer, comparing to each key in the combo
+       // Check if this is a long Trigger Macro
+       uint8_t longMacro = Macro_isLongTriggerMacro( macro );
+
+       // Iterate through the items in the combo, voting the on the key state
        // If any of the pressed keys do not match, fail the macro
        //
        // The macro is waiting for input when in the TriggerMacro_Waiting state
@@ -443,21 +630,23 @@ inline TriggerMacroEval Macro_evalTriggerMacro( unsigned int triggerMacroIndex )
        // TODO Add support for 0x00 Key state (not pressing a key, not all that useful in general)
        // TODO Add support for Press/Hold/Release differentiation when evaluating (not sure if useful)
        TriggerMacroVote overallVote = TriggerMacroVote_Invalid;
-       for ( uint8_t key = 0; key < macroTriggerListBufferSize; key++ )
+       for ( uint8_t comboItem = pos + 1; comboItem < pos + comboLength + 1; comboItem += TriggerGuideSize )
        {
-               // Lookup key information
-               TriggerGuide *keyInfo = &macroTriggerListBuffer[ key ];
+               // Assign TriggerGuide element (key type, state and scancode)
+               TriggerGuide *guide = (TriggerGuide*)(&macro->guide[ comboItem ]);
 
-               // Iterate through the items in the combo, voting the on the key state
                TriggerMacroVote vote = TriggerMacroVote_Invalid;
-               for ( uint8_t comboItem = pos + 1; comboItem < pos + comboLength + 1; comboItem += TriggerGuideSize )
+               // Iterate through the key buffer, comparing to each key in the combo
+               for ( uint8_t key = 0; key < macroTriggerListBufferSize; key++ )
                {
-                       // Assign TriggerGuide element (key type, state and scancode)
-                       TriggerGuide *guide = (TriggerGuide*)(&macro->guide[ comboItem ]);
+                       // Lookup key information
+                       TriggerGuide *keyInfo = &macroTriggerListBuffer[ key ];
 
                        // If vote is a pass (>= 0x08, no more keys in the combo need to be looked at)
                        // Also mask all of the non-passing votes
-                       vote |= Macro_evalTriggerMacroVote( keyInfo, guide );
+                       vote |= longMacro
+                               ? Macro_evalLongTriggerMacroVote( keyInfo, guide )
+                               : Macro_evalShortTriggerMacroVote( keyInfo, guide );
                        if ( vote >= TriggerMacroVote_Pass )
                        {
                                vote &= TriggerMacroVote_Release | TriggerMacroVote_PassRelease | TriggerMacroVote_Pass;
@@ -465,10 +654,20 @@ inline TriggerMacroEval Macro_evalTriggerMacro( unsigned int triggerMacroIndex )
                        }
                }
 
+               // If no pass vote was found after scanning all of the keys
+               // Fail the combo, if this is a short macro (long macros already will have a fail vote)
+               if ( !longMacro && vote < TriggerMacroVote_Pass )
+                       vote |= TriggerMacroVote_Fail;
+
                // After voting, append to overall vote
                overallVote |= vote;
        }
 
+       // If no pass vote was found after scanning the entire combo
+       // And this is the first position in the combo, just remove it (nothing important happened)
+       if ( longMacro && overallVote & TriggerMacroVote_DoNothingRelease && pos == 0 )
+               overallVote |= TriggerMacroVote_Fail;
+
        // Decide new state of macro after voting
        // Fail macro, remove from pending list
        if ( overallVote & TriggerMacroVote_Fail )
@@ -476,35 +675,68 @@ inline TriggerMacroEval Macro_evalTriggerMacro( unsigned int triggerMacroIndex )
                return TriggerMacroEval_Remove;
        }
        // Do nothing, incorrect key is being held or released
-       else if ( overallVote & TriggerMacroVote_DoNothing )
+       else if ( overallVote & TriggerMacroVote_DoNothing && longMacro )
        {
                // Just doing nothing :)
        }
        // If passing and in Waiting state, set macro state to Press
-       else if ( overallVote & TriggerMacroVote_Pass && macro->state == TriggerMacro_Waiting )
+       else if ( overallVote & TriggerMacroVote_Pass
+            && ( macro->state == TriggerMacro_Waiting || macro->state == TriggerMacro_Press ) )
        {
                macro->state = TriggerMacro_Press;
 
                // If in press state, and this is the final combo, send request for ResultMacro
                // Check to see if the result macro only has a single element
                // If this result macro has more than 1 key, only send once
-               // TODO Add option to have macro repeat rate
-               if ( macro->guide[ pos + comboLength ] == 0 )
+               // TODO Add option to have long macro repeat rate
+               if ( macro->guide[ pos + comboLength + 1 ] == 0 )
                {
-                       // Long Macro, only send once (more than 1 sequence item)
-                       // Short Macro (only 1 sequence item)
-                       return Macro_isLongResultMacro( &ResultMacroList[ macro->result ] )
-                               ? TriggerMacroEval_DoResult
-                               : TriggerMacroEval_DoResultAndRemove;
+                       // Long result macro (more than 1 combo)
+                       if ( Macro_isLongResultMacro( &ResultMacroList[ macro->result ] ) )
+                       {
+                               // Only ever trigger result once, on press
+                               if ( overallVote == TriggerMacroVote_Pass )
+                               {
+                                       return TriggerMacroEval_DoResultAndRemove;
+                               }
+                       }
+                       // Short result macro
+                       else
+                       {
+                               // Only trigger result once, on press, if long trigger (more than 1 combo)
+                               if ( Macro_isLongTriggerMacro( macro ) )
+                               {
+                                       return TriggerMacroEval_DoResultAndRemove;
+                               }
+                               // Otherwise, trigger result continuously
+                               else
+                               {
+                                       return TriggerMacroEval_DoResult;
+                               }
+                       }
                }
-
        }
        // If ready for transition and in Press state, set to Waiting and increment combo position
        // Position is incremented (and possibly remove the macro from the pending list) on the next iteration
        else if ( overallVote & TriggerMacroVote_Release && macro->state == TriggerMacro_Press )
        {
                macro->state = TriggerMacro_Release;
+
+               // If this is the last combo in the sequence, remove from the pending list
+               if ( macro->guide[ macro->pos + macro->guide[ macro->pos ] * TriggerGuideSize + 1 ] == 0 )
+                       return TriggerMacroEval_Remove;
        }
+       // Otherwise, just remove the macro on key release
+       // One more result has to be called to indicate to the ResultMacro that the key transitioned to the release state
+       else if ( overallVote & TriggerMacroVote_Release )
+       {
+               return TriggerMacroEval_DoResultAndRemove;
+       }
+
+       // If this is a short macro, just remove it
+       // The state can be rebuilt on the next iteration
+       if ( !longMacro )
+               return TriggerMacroEval_Remove;
 
        return TriggerMacroEval_DoNothing;
 }
@@ -522,12 +754,6 @@ inline ResultMacroEval Macro_evalResultMacro( unsigned int resultMacroIndex )
        // Length of combo being processed
        uint8_t comboLength = macro->guide[ pos ];
 
-       // If no combo items are left, remove the ResultMacro from the pending list
-       if ( comboLength == 0 )
-       {
-               return ResultMacroEval_Remove;
-       }
-
        // Function Counter, used to keep track of the combo items processed
        unsigned int funcCount = 0;
 
@@ -538,7 +764,7 @@ inline ResultMacroEval Macro_evalResultMacro( unsigned int resultMacroIndex )
        while ( funcCount < comboLength )
        {
                // Assign TriggerGuide element (key type, state and scancode)
-               ResultGuide *guide = (ResultGuide*)(&macro->guide[ pos ]);
+               ResultGuide *guide = (ResultGuide*)(&macro->guide[ comboItem ]);
 
                // Do lookup on capability function
                void (*capability)(uint8_t, uint8_t, uint8_t*) = (void(*)(uint8_t, uint8_t, uint8_t*))(CapabilitiesList[ guide->index ].func);
@@ -554,22 +780,34 @@ inline ResultMacroEval Macro_evalResultMacro( unsigned int resultMacroIndex )
        // Move to next item in the sequence
        macro->pos = comboItem;
 
-       // If the ResultMacro is finished, it will be removed on the next iteration
+       // If the ResultMacro is finished, remove
+       if ( macro->guide[ comboItem ] == 0 )
+       {
+               return ResultMacroEval_Remove;
+       }
+
+       // Otherwise leave the macro in the list
        return ResultMacroEval_DoNothing;
 }
 
 
 // Update pending trigger list
-void Macro_updateTriggerMacroPendingList()
+inline void Macro_updateTriggerMacroPendingList()
 {
        // Iterate over the macroTriggerListBuffer to add any new Trigger Macros to the pending list
        for ( uint8_t key = 0; key < macroTriggerListBufferSize; key++ )
        {
+               // TODO LED States
+               // TODO Analog Switches
+               // Only add TriggerMacro to pending list if key was pressed (not held, released or off)
+               if ( macroTriggerListBuffer[ key ].state == 0x00 && macroTriggerListBuffer[ key ].state != 0x01 )
+                       continue;
+
                // Lookup Trigger List
-               unsigned int *triggerList = Macro_layerLookup( macroTriggerListBuffer[ key ].scanCode );
+               nat_ptr_t *triggerList = Macro_layerLookup( macroTriggerListBuffer[ key ].scanCode );
 
                // Number of Triggers in list
-               unsigned int triggerListSize = triggerList[0];
+               nat_ptr_t triggerListSize = triggerList[0];
 
                // Iterate over triggerList to see if any TriggerMacros need to be added
                // First item is the number of items in the TriggerList
@@ -593,6 +831,10 @@ void Macro_updateTriggerMacroPendingList()
                        if ( pending == macroTriggerMacroPendingListSize )
                        {
                                macroTriggerMacroPendingList[ macroTriggerMacroPendingListSize++ ] = triggerMacroIndex;
+
+                               // Reset macro position
+                               TriggerMacroList[ triggerMacroIndex ].pos   = 0;
+                               TriggerMacroList[ triggerMacroIndex ].state = TriggerMacro_Waiting;
                        }
                }
        }
@@ -615,6 +857,7 @@ inline void Macro_process()
 
                // Proceed, decrementing the step counter
                macroStepCounter--;
+               dbug_print("Macro Step");
        }
 
        // Update pending trigger list, before processing TriggerMacros
@@ -632,9 +875,8 @@ inline void Macro_process()
                // Trigger Result Macro (purposely falling through)
                case TriggerMacroEval_DoResult:
                        // Append ResultMacro to PendingList
-                       Macro_appendResultMacroToPendingList( TriggerMacroList[ macroTriggerMacroPendingList[ macro ] ].result );
+                       Macro_appendResultMacroToPendingList( &TriggerMacroList[ macroTriggerMacroPendingList[ macro ] ] );
 
-               // Otherwise, just re-add
                default:
                        macroTriggerMacroPendingList[ macroTriggerMacroPendingListTail++ ] = macroTriggerMacroPendingList[ macro ];
                        break;
@@ -642,7 +884,7 @@ inline void Macro_process()
                // Trigger Result Macro and Remove (purposely falling through)
                case TriggerMacroEval_DoResultAndRemove:
                        // Append ResultMacro to PendingList
-                       Macro_appendResultMacroToPendingList( TriggerMacroList[ macroTriggerMacroPendingList[ macro ] ].result );
+                       Macro_appendResultMacroToPendingList( &TriggerMacroList[ macroTriggerMacroPendingList[ macro ] ] );
 
                // Remove Macro from Pending List, nothing to do, removing by default
                case TriggerMacroEval_Remove:
@@ -713,9 +955,8 @@ inline void Macro_setup()
        // Initialize TriggerMacro states
        for ( unsigned int macro = 0; macro < TriggerMacroNum; macro++ )
        {
-               TriggerMacroList[ macro ].result = 0;
-               TriggerMacroList[ macro ].pos    = 0;
-               TriggerMacroList[ macro ].state  = TriggerMacro_Waiting;
+               TriggerMacroList[ macro ].pos   = 0;
+               TriggerMacroList[ macro ].state = TriggerMacro_Waiting;
        }
 
        // Initialize ResultMacro states
@@ -734,6 +975,7 @@ void cliFunc_capList( char* args )
 {
        print( NL );
        info_msg("Capabilities List");
+       printHex( CapabilitiesNum );
 
        // Iterate through all of the capabilities and display them
        for ( unsigned int cap = 0; cap < CapabilitiesNum; cap++ )
@@ -780,7 +1022,7 @@ void cliFunc_capSelect( char* args )
                // Keyboard Capability
                case 'K':
                        // Determine capability index
-                       cap = decToInt( &arg1Ptr[1] );
+                       cap = numToInt( &arg1Ptr[1] );
 
                        // Lookup the number of args
                        totalArgs += CapabilitiesList[ cap ].argCount;
@@ -789,7 +1031,7 @@ void cliFunc_capSelect( char* args )
 
                // Because allocating memory isn't doable, and the argument count is arbitrary
                // The argument pointer is repurposed as the argument list (much smaller anyways)
-               argSet[ argSetCount++ ] = (uint8_t)decToInt( arg1Ptr );
+               argSet[ argSetCount++ ] = (uint8_t)numToInt( arg1Ptr );
 
                // Once all the arguments are prepared, call the keyboard capability function
                if ( argSetCount == totalArgs )
@@ -812,6 +1054,34 @@ void cliFunc_capSelect( char* args )
        }
 }
 
+void cliFunc_keyHold( char* args )
+{
+       // Parse codes from arguments
+       char* curArgs;
+       char* arg1Ptr;
+       char* arg2Ptr = args;
+
+       // Process all args
+       for ( ;; )
+       {
+               curArgs = arg2Ptr;
+               CLI_argumentIsolation( curArgs, &arg1Ptr, &arg2Ptr );
+
+               // Stop processing args if no more are found
+               if ( *arg1Ptr == '\0' )
+                       break;
+
+               // Ignore non-Scancode numbers
+               switch ( arg1Ptr[0] )
+               {
+               // Scancode
+               case 'S':
+                       Macro_keyState( (uint8_t)numToInt( &arg1Ptr[1] ), 0x02 ); // Hold scancode
+                       break;
+               }
+       }
+}
+
 void cliFunc_keyPress( char* args )
 {
        // Parse codes from arguments
@@ -834,7 +1104,7 @@ void cliFunc_keyPress( char* args )
                {
                // Scancode
                case 'S':
-                       Macro_keyState( (uint8_t)decToInt( &arg1Ptr[1] ), 0x01 ); // Press scancode
+                       Macro_keyState( (uint8_t)numToInt( &arg1Ptr[1] ), 0x01 ); // Press scancode
                        break;
                }
        }
@@ -862,7 +1132,7 @@ void cliFunc_keyRelease( char* args )
                {
                // Scancode
                case 'S':
-                       Macro_keyState( (uint8_t)decToInt( &arg1Ptr[1] ), 0x03 ); // Release scancode
+                       Macro_keyState( (uint8_t)numToInt( &arg1Ptr[1] ), 0x03 ); // Release scancode
                        break;
                }
        }
@@ -881,7 +1151,7 @@ void cliFunc_layerList( char* args )
                print(" - ");
 
                // Display layer name
-               dPrint( LayerIndex[ layer ].name );
+               dPrint( (char*)LayerIndex[ layer ].name );
 
                // Default map
                if ( layer == 0 )
@@ -924,11 +1194,11 @@ void cliFunc_layerState( char* args )
                        if ( arg1Ptr[0] != 'L' )
                                return;
 
-                       arg1 = (uint8_t)decToInt( &arg1Ptr[1] );
+                       arg1 = (uint8_t)numToInt( &arg1Ptr[1] );
                        break;
                // Second argument (e.g. 4)
                case 1:
-                       arg2 = (uint8_t)decToInt( arg1Ptr );
+                       arg2 = (uint8_t)numToInt( arg1Ptr );
 
                        // Display operation (to indicate that it worked)
                        print( NL );
@@ -956,6 +1226,39 @@ void cliFunc_macroDebug( char* args )
 
 void cliFunc_macroList( char* args )
 {
+       // Show pending key events
+       print( NL );
+       info_msg("Pending Key Events: ");
+       printInt16( (uint16_t)macroTriggerListBufferSize );
+       print(" : ");
+       for ( uint8_t key = 0; key < macroTriggerListBufferSize; key++ )
+       {
+               printHex( macroTriggerListBuffer[ key ].scanCode );
+               print(" ");
+       }
+
+       // Show pending trigger macros
+       print( NL );
+       info_msg("Pending Trigger Macros: ");
+       printInt16( (uint16_t)macroTriggerMacroPendingListSize );
+       print(" : ");
+       for ( unsigned int macro = 0; macro < macroTriggerMacroPendingListSize; macro++ )
+       {
+               printHex( macroTriggerMacroPendingList[ macro ] );
+               print(" ");
+       }
+
+       // Show pending result macros
+       print( NL );
+       info_msg("Pending Result Macros: ");
+       printInt16( (uint16_t)macroResultMacroPendingListSize );
+       print(" : ");
+       for ( unsigned int macro = 0; macro < macroResultMacroPendingListSize; macro++ )
+       {
+               printHex( macroResultMacroPendingList[ macro ] );
+               print(" ");
+       }
+
        // Show available trigger macro indices
        print( NL );
        info_msg("Trigger Macros Range: T0 -> T");
@@ -1049,6 +1352,15 @@ void macroDebugShowTrigger( unsigned int index )
        // Display result macro index
        print( NL "Result Macro Index: " );
        printInt16( (uint16_t)macro->result ); // Hopefully large enough :P (can't assume 32-bit)
+
+       // Display trigger macro state
+       print( NL "Trigger Macro State: " );
+       switch ( macro->state )
+       {
+       case TriggerMacro_Press:   print("Press");   break;
+       case TriggerMacro_Release: print("Release"); break;
+       case TriggerMacro_Waiting: print("Waiting"); break;
+       }
 }
 
 void macroDebugShowResult( unsigned int index )
@@ -1158,11 +1470,11 @@ void cliFunc_macroShow( char* args )
                {
                // Indexed Trigger Macro
                case 'T':
-                       macroDebugShowTrigger( decToInt( &arg1Ptr[1] ) );
+                       macroDebugShowTrigger( numToInt( &arg1Ptr[1] ) );
                        break;
                // Indexed Result Macro
                case 'R':
-                       macroDebugShowResult( decToInt( &arg1Ptr[1] ) );
+                       macroDebugShowResult( numToInt( &arg1Ptr[1] ) );
                        break;
                }
        }
@@ -1176,7 +1488,13 @@ void cliFunc_macroStep( char* args )
        char* arg2Ptr;
        CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr );
 
+       // Default to 1, if no argument given
+       unsigned int count = (unsigned int)numToInt( arg1Ptr );
+
+       if ( count == 0 )
+               count = 1;
+
        // Set the macro step counter, negative int's are cast to uint
-       macroStepCounter = (unsigned int)decToInt( arg1Ptr );
+       macroStepCounter = count;
 }