Reset bus after phase error

uweseimet · Dec 11, 2024 · 5f6618f · 5f6618f
1 parent 084491b
commit 5f6618f
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/cpp/controllers/controller.cpp b/cpp/controllers/controller.cpp
@@ -108,6 +108,7 @@ void Controller::Command()
                 Error(sense_key::illegal_request, asc::invalid_command_operation_code);
             }
             else {
+                GetBus().SetRST(true);
                 Error(sense_key::aborted_command, asc::command_phase_error);
             }
             return;
@@ -130,6 +131,7 @@ void Controller::Command()
         if (actual_count != command_bytes_count) {
             LogWarn(fmt::format("Received {0} byte(s) in COMMAND phase for command ${1:02x}, {2} required",
                 command_bytes_count, GetCdb()[0], actual_count));
+            GetBus().SetRST(true);
             Error(sense_key::aborted_command, asc::command_phase_error);
             return;
         }
@@ -337,6 +339,7 @@ void Controller::Send()
         if (const int l = GetBus().SendHandShake(GetBuffer().data() + GetOffset(), length,
             GetDeviceForLun(0)->GetDelayAfterBytes()); l != length) {
             LogWarn(fmt::format("Sent {0} byte(s), {1} required", l, length));
+            GetBus().SetRST(true);
             Error(sense_key::aborted_command, asc::data_phase_error);
             return;
         }
@@ -398,6 +401,7 @@ void Controller::Receive()
 
         if (const int l = GetBus().ReceiveHandShake(GetBuffer().data() + GetOffset(), length); l != length) {
             LogWarn(fmt::format("Received {0} byte(s), {1} required", l, length));
+            GetBus().SetRST(true);
             Error(sense_key::aborted_command, asc::data_phase_error);
             return;
         }