eh$ddlZddlZGddZddZ ddZedkrededd Zeeed ed d d dZ ee ede dd e ddeedSdS)NcLeZdZdZdZ ddZddZdd Zd Zd Z d Z d Z dS)DeadbandControllerz Controls deadbands for duty and polarity signals. Allows configurable timing offsets for rising and falling edges. cd|_d|_d|_d|_d|_d|_d|_d|_tj |_ dS)NgF) duty_rising_deadbandduty_falling_deadbandpolarity_rising_deadbandpolarity_falling_deadbandduty_last_statepolarity_last_state duty_timerpolarity_timer threadingLocklockselfs */home/morepork/Documents/CSEM/deadbands.py__init__zDeadbandController.__init__ s\%+!%+"(.%)/& %#( "N$$ Nc|j5|||_|||_|||_|||_ddddS#1swxYwYdS)a Configure deadband timing for signal edges. Args: duty_rising: Deadband for duty signal rising edge (seconds) duty_falling: Deadband for duty signal falling edge (seconds) polarity_rising: Deadband for polarity signal rising edge (seconds) polarity_falling: Deadband for polarity signal falling edge (seconds) N)rrrrr )r duty_rising duty_fallingpolarity_risingpolarity_fallings rconfigure_deadbandsz&DeadbandController.configure_deadbandssY B B&,7)'-9**0?-+1A. B B B B B B B B B B B B B B B B B Bs %:>>c@||dz |dz dS)z Convenience method to set duty deadbands in milliseconds. Args: rising_ms: Rising edge deadband in milliseconds falling_ms: Falling edge deadband in milliseconds @@)rrNrr rising_ms falling_mss rset_duty_deadbandsz%DeadbandController.set_duty_deadbands2s;   !F*#f, !     rrc@||dz |dz dS)z Convenience method to set polarity deadbands in milliseconds. Args: rising_ms: Rising edge deadband in milliseconds falling_ms: Falling edge deadband in milliseconds r)rrNr r!s rset_polarity_deadbandsz)DeadbandController.set_polarity_deadbands?s;   %.'&0 !     rc|j5|j |jd|_||jkra|r|j}n|j}||_|dkr ||nBt j|||g|_|jn ||ddddS#1swxYwYdS)z Apply deadband to duty signal state change. Args: new_state: New boolean state for duty signal callback: Function to call with the final state after deadband Nrargs) rr cancelr rrrTimerstartr new_statecallback deadband_times rapply_duty_deadbandz&DeadbandController.apply_duty_deadbandLs.Y $ $*&&((("&D000?$($=MM$($>M(1$!A%%HY'''''0omXU^T_&`&`&`DOO))++++###3 $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $BB44B8;B8c|j5|j |jd|_||jkra|r|j}n|j}||_|dkr ||nBt j|||g|_|jn ||ddddS#1swxYwYdS)z Apply deadband to polarity signal state change. Args: new_state: New boolean state for polarity signal callback: Function to call with the final state after deadband Nrr() rr r*r rr rr+r,r-s rapply_polarity_deadbandz*DeadbandController.apply_polarity_deadbandos4Y $ $".#**,,,&*#D444C$($AMM$($BM,5(!A%%HY''''+4/-YbXc*d*d*dD''--////###3 $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $ $r2c|j5|j |jd|_|j |jd|_d|_d|_ddddS#1swxYwYdS)zrrrrs %%%&BFBFBBBB*          !$!$!$F!$!$!$F - - -rrrczt}|||||||S)a  Create a deadband controller with symmetric deadbands. Args: duty_ms: Deadband for duty signal edges (milliseconds) polarity_ms: Deadband for polarity signal edges (milliseconds) Returns: DeadbandController instance )rr$r&)duty_ms polarity_ms controllers rcreate_deadband_controllerrHsA$%%J!!'7333%%k;??? rclt}||dz |dz |dz |dz |S)a Create a deadband controller with asymmetric deadbands. Args: duty_rising_ms: Duty signal rising edge deadband (milliseconds) duty_falling_ms: Duty signal falling edge deadband (milliseconds) polarity_rising_ms: Polarity signal rising edge deadband (milliseconds) polarity_falling_ms: Polarity signal falling edge deadband (milliseconds) Returns: DeadbandController instance r)rrrr)rr)r8r9r:r;rGs r%create_asymmetric_deadband_controllerrJsT$%%J"""V+$v-*V3,v5 # r__main__z"Example 1: Symmetric 5ms deadbands)rErFz Example 2: Asymmetric deadbands)r8r9r:r;z Example 3: Modifying deadbands )r"r#)rr)rrrr) rtimerrHrJr?printrGr> controller2r$r&rCrrrVs llllllll`"MNRS2 z E .///++A1EEEJ E* & & ( ())) E -...77 K  E+ ' ' ) )*** E ,---!!B1!===%%b%AAA E* & & ( ())))))r