enable pd comms

enable pd comms to add pd supply capabilities to power.SupplyCapabilities(), limit the maximum voltage requested to 5V and cap current request to max input current.
emfcamp · Jul 16, 2024 · e54ca01 · e54ca01
1 parent 17b9261
commit e54ca01
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 6 deletions.
diff --git a/drivers/tildagon_power/fusb302b/fusb302b_pd.c b/drivers/tildagon_power/fusb302b/fusb302b_pd.c
@@ -99,7 +99,7 @@ uint8_t fusbpd_select_pdo( pd_state_t* state )
         if (
             ( state->pdos[i].fixed.pdo_type == PD_FIXED_SUPPLY )
             && ( voltage > highest_voltage )
-            && ( voltage < 14000 )
+            && ( voltage <= 5000U )
         )
         {
             highest_voltage = voltage;

diff --git a/drivers/tildagon_power/tildagon_power.c b/drivers/tildagon_power/tildagon_power.c
@@ -310,8 +310,7 @@ void device_unattached_handler( event_t event )
         determine_input_current_limit( &usb_in );
         if ( ( usb_in.fusb.input_current_limit >= 1500 ) && ( device_pd_state == NOT_STARTED ) )
         {
-            //todo enable device pd
-            //fusb_setup_pd( &usb_in.fusb );
+            fusb_setup_pd( &usb_in.fusb );
             device_pd_state = WAITING;
         }
         fusb_mask_interrupt_bclevel( &usb_in.fusb, 1 );
@@ -334,8 +333,7 @@ void device_attached_handler( event_t event )
         determine_input_current_limit( &usb_in );
         if ( ( usb_in.fusb.input_current_limit >= 1500 ) && ( device_pd_state == NOT_STARTED ) )
         {
-            //todo enable device pd
-            //fusb_setup_pd( &usb_in.fusb );
+            fusb_setup_pd( &usb_in.fusb );
             device_pd_state = WAITING;
         }
         fusb_mask_interrupt_bclevel( &usb_in.fusb, 1 );
@@ -365,7 +363,12 @@ void device_pd_machine ( event_t event )
                 if ( usb_in.pd.last_rx_data_msg_type == PD_DATA_SOURCE_CAPABILITIES )
                 {
                     uint8_t index = fusbpd_select_pdo( &usb_in.pd );
-                    fusbpd_request_power( &usb_in.pd, index, usb_in.pd.pdos[index].fixed.max_current * 10, usb_in.pd.pdos[index].fixed.max_current * 10 );
+                    uint32_t current = usb_in.pd.pdos[index].fixed.max_current * 10;
+                    if ( current > 3250 )
+                    {
+                        current = 3250;
+                    }
+                    fusbpd_request_power( &usb_in.pd, index, current, current );
                     fusb_send( &usb_in.fusb, usb_in.pd.tx_buffer, usb_in.pd.message_length );  
                     usb_in.pd.last_rx_data_msg_type = PD_DATA_DO_NOT_USE; 
                     device_pd_state = POWER_REQUESTED;