Updated DoorControl and DriveControl; Added IT:SD4A

Updated DoorControl
Updated DriveControl
Integration Test: SD4A
Updated Integration Test Log