Adding dynamic USB power support

[kiibohd-controller.git] / Scan / UARTConnect / connect_scan.c

diff --git a/Scan/UARTConnect/connect_scan.c b/Scan/UARTConnect/connect_scan.c
index 55f6619c61325d3509074b454cd2a29d487a0d33..4c56c3cf2d06e90db2006a5f9d54da7b6e5017e5 100644 (file)
--- a/Scan/UARTConnect/connect_scan.c
+++ b/Scan/UARTConnect/connect_scan.c
@@ -1,4 +1,4 @@
-/* Copyright (C) 2014-2015 by Jacob Alexander
+/* Copyright (C) 2014-2016 by Jacob Alexander
  *
  * This file is free software: you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
@@ -470,6 +470,14 @@ uint8_t Connect_receive_CableCheck( uint8_t byte, uint16_t *pending_bytes, uint8
                        }
                        else
                        {
+                               // Lower current requirement during errors
+                               // USB minimum
+                               // Only if this is not the master node
+                               if ( Connect_id != 0 )
+                               {
+                                       Output_update_external_current( 100 );
+                               }
+
                                Connect_cableFaultsMaster++;
                                Connect_cableOkMaster = 0;
                                print(" Master ");
@@ -489,6 +497,12 @@ uint8_t Connect_receive_CableCheck( uint8_t byte, uint16_t *pending_bytes, uint8
                        }
                        else
                        {
+                               // If we already have an Id, then set max current again
+                               if ( Connect_id != 255 && Connect_id != 0 )
+                               {
+                                       // TODO reset to original negotiated current
+                                       Output_update_external_current( 500 );
+                               }
                                Connect_cableChecksMaster++;
                        }
                }
@@ -560,6 +574,14 @@ uint8_t Connect_receive_IdEnumeration( uint8_t id, uint16_t *pending_bytes, uint
        // Send reponse back to master
        Connect_send_IdReport( id );
 
+       // Node now enumerated, set external power to USB Max
+       // Only set if this is not the master node
+       // TODO Determine power slice for each node as part of protocol
+       if ( Connect_id != 0 )
+       {
+               Output_update_external_current( 500 );
+       }
+
        // Propogate next Id if the connection is ok
        if ( Connect_cableOkSlave )
        {
@@ -1177,6 +1199,13 @@ void Connect_scan()
 }
 
 
+// Called by parent Scan module whenever the available current changes
+void Connect_currentChange( unsigned int current )
+{
+       // TODO - Any potential power saving here?
+}
+
+
 
 // ----- CLI Command Functions -----