add launchController and implement launch control capability

[mathbrook]

with this PR I am hoping to implement a launch control system that follows the state behavior and has the same functionality as the code in https://github.com/KSU-MS/KS6e-VCU-firmware/tree/launch

design ideas

• keep launch control's manipulation of the torque command separate from the pedal's torque calculation
• ie. do not run launch control algorithm inside calculate_torque, instead have a separate object manipulate the torque value in the state machine where we have most visibility
• added launchController class with its own state enum to handle the different states and conditions of launch control mode
• using mcu_status launch control flag to manage entering the launch control logic

stateDiagram-v2

    rtd : READY_TO_DRIVE
    rtd --> checkButtons
    checkButtons-->toggle_lc:toggle lc if buttons are pressed
    state toggle_lc{
        toggle_get_lc_active-->set_lc_active(1):set to 1 if it was 0
        toggle_get_lc_active-->set_lc_active(0):set to 0 if it was 1
        set_lc_active(1)-->[*]
        set_lc_active(0)-->[*]
    }
    toggle_lc -->get_lc_active
    checkButtons-->get_lc_active:if buttons are not held go to check lc state
    get_lc_active-->launchState:mcu_status.get_launch_ctrl_active returns 1
    get_lc_active-->command_torque:mcu_status.get_launch_ctrl_active returns 0
    state launchState{
        idle-->waiting:gas pressed, button pressed, and no implaus
        idle-->[*]
        waiting-->idle: gas released or implaus
        waiting-->[*]
        waiting-->launching: gas still pressed and button released 
        launching-->finished: brake pressed (cancel early)
        launching-->finished: time completed
        launching-->[*]:launching in progress
        finished-->[*]:launch control done, set launch_ctrl_active to 0
    }
    launchState-->command_torque:deactivate LC when finished
    command_torque-->rtd:return to start of RTD loop

Loading