1 files changed, 4 insertions, 0 deletions
diff --git a/os/ex/ST/l3gd20.c b/os/ex/ST/l3gd20.c
index 1030abb97..c618a8c8d 100644
--- a/os/ex/ST/l3gd20.c
+++ b/os/ex/ST/l3gd20.c
@@ -332,6 +332,10 @@ static msg_t reset_sensivity(void *ip) {
   else if(((L3GD20Driver *)ip)->config->fullscale == L3GD20_FS_2000DPS)
 	for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++)
       ((L3GD20Driver *)ip)->sensitivity[i] = L3GD20_SENS_2000DPS;
+  else {
+    osalDbgAssert(FALSE, "reset_sensivity(), full scale issue");
+    return MSG_RESET;
+  }
   return MSG_OK;
 }