1 files changed, 56 insertions, 3 deletions

diff --git a/tests/test_core.c b/tests/test_core.c
index 65af8580..35e948ee 100644
--- a/tests/test_core.c
+++ b/tests/test_core.c
@@ -1,13 +1,56 @@
+#include <obd2/obd2.h>
 #include <check.h>
 #include <stdint.h>
 #include <stdio.h>
 #include <stdbool.h>
 
-void setup() {
+extern void setup();
+extern bool last_response_was_received;
+extern DiagnosticResponse last_response_received;
+extern DiagnosticShims SHIMS;
+extern DiagnosticResponseReceived response_received_handler;
 
+START_TEST (test_receive_wrong_arb_id)
+{
+    ck_assert(false);
 }
+END_TEST
+
+START_TEST (test_send_diag_request)
+{
+    DiagnosticRequest request = {
+        arbitration_id: 0x7df,
+        mode: OBD2_MODE_POWERTRAIN_DIAGNOSTIC_REQUEST
+    };
+    DiagnosticRequestHandle handle = diagnostic_request(&SHIMS, &request,
+            response_received_handler);
+
+    fail_if(last_response_was_received);
+    const uint8_t can_data[] = {0x2, request.mode + 0x40, 0x23};
+    diagnostic_receive_can_frame(&handle, request.arbitration_id + 0x8,
+            can_data, sizeof(can_data));
+    fail_unless(last_response_was_received);
+    ck_assert(last_response_received.success);
+    ck_assert_int_eq(last_response_received.arbitration_id,
+            request.arbitration_id + 0x8);
+    // TODO should we set it back to the original mode, or leave as mode + 0x40?
+    ck_assert_int_eq(last_response_received.mode, request.mode);
+    ck_assert_int_eq(last_response_received.pid, 0);
+    ck_assert_int_eq(last_response_received.payload_length, 1);
+    ck_assert_int_eq(last_response_received.payload[0], can_data[2]);
+}
+END_TEST
 
-START_TEST (test_fail)
+START_TEST (test_request_pid_standard)
+{
+    fail_unless(false);
+    // TODO test request pid, do the same rigamarole
+    //      kind of leaky, but check that the returned DiagnosticRequest Handle
+    //      has the right PID
+}
+END_TEST
+
+START_TEST (test_request_pid_enhanced)
 {
     fail_unless(false);
 }
@@ -17,7 +60,17 @@ Suite* testSuite(void) {
     Suite* s = suite_create("obd2");
     TCase *tc_core = tcase_create("core");
     tcase_add_checked_fixture(tc_core, setup, NULL);
-    tcase_add_test(tc_core, test_fail);
+    tcase_add_test(tc_core, test_send_diag_request);
+    tcase_add_test(tc_core, test_receive_wrong_arb_id);
+    tcase_add_test(tc_core, test_request_pid_standard);
+    tcase_add_test(tc_core, test_request_pid_enhanced);
+
+    // TODO these are future work:
+    // TODO test request MIL
+    // TODO test request VIN
+    // TODO test request DTC
+    // TODO test clear DTC
+    // TODO test enumerate PIDs
     suite_add_tcase(s, tc_core);
 
     return s;