diff --git a/tests/gy521_driver/test_gy521_driver.c b/tests/gy521_driver/test_gy521_driver.c
index 5bb379f..1b19692 100644
--- a/tests/gy521_driver/test_gy521_driver.c
+++ b/tests/gy521_driver/test_gy521_driver.c
@@ -351,6 +351,15 @@ static void test_gyro_update(void **state)
     assert_true(1);
 }
 
+static void test_enable_self_test_gyro(void **state)
+{
+    //expect_value(func, param, val);
+    
+    /*The read register function should be called with */
+    expect_value(read_register, reg, 27);
+    enable_self_test_gyro(*state);
+}
+
 
 int main(void)
 {
@@ -360,6 +369,7 @@ int main(void)
     const struct CMUnitTest twi_group[] = {
         cmocka_unit_test_setup_teardown(test_gy521_testing, setup_gy521_instance, teardown_gy521_instance),
         cmocka_unit_test_setup_teardown(test_gyro_update, setup_gy521_instance, teardown_gy521_instance),
+        cmocka_unit_test_setup_teardown(test_enable_self_test_gyro, setup_gy521_instance, teardown_gy521_instance),
     }; 
     const struct CMUnitTest tests[] = {
         cmocka_unit_test(test_gy521_init),