1 files changed, 9 insertions, 6 deletions
diff --git a/os/ex/ST/l3gd20.c b/os/ex/ST/l3gd20.c
index 17100ca36..9a98ec145 100644
--- a/os/ex/ST/l3gd20.c
+++ b/os/ex/ST/l3gd20.c
@@ -247,7 +247,8 @@ static msg_t gyro_sample_bias(void *ip) {
  */
 static msg_t gyro_set_bias(void *ip, float *bp) {
   L3GD20Driver* devp;
-  uint32_t i;
+  uint32_t i;
+  msg_t msg = MSG_OK;
   
   osalDbgCheck((ip != NULL) && (bp != NULL));
   
@@ -260,7 +261,7 @@ static msg_t gyro_set_bias(void *ip, float *bp) {
   for(i = 0; i < L3GD20_GYRO_NUMBER_OF_AXES; i++) {
     devp->gyrobias[i] = bp[i];
   }
-  return MSG_OK;
+  return msg;
 }
 
 /**
@@ -275,7 +276,8 @@ static msg_t gyro_set_bias(void *ip, float *bp) {
  */
 static msg_t gyro_reset_bias(void *ip) {
   L3GD20Driver* devp;
-  uint32_t i;
+  uint32_t i;
+  msg_t msg = MSG_OK;
 
   osalDbgCheck(ip != NULL);
   
@@ -287,7 +289,7 @@ static msg_t gyro_reset_bias(void *ip) {
 
   for(i = 0; i < L3GD20_GYRO_NUMBER_OF_AXES; i++)
     devp->gyrobias[i] = L3GD20_GYRO_BIAS;
-  return MSG_OK;
+  return msg;
 }
 
 /**
@@ -304,7 +306,8 @@ static msg_t gyro_reset_bias(void *ip) {
  */
 static msg_t gyro_set_sensivity(void *ip, float *sp) {
   L3GD20Driver* devp;
-  uint32_t i;
+  uint32_t i;
+  msg_t msg = MSG_OK;
   
   osalDbgCheck((ip != NULL) && (sp !=NULL));
 
@@ -317,7 +320,7 @@ static msg_t gyro_set_sensivity(void *ip, float *sp) {
   for(i = 0; i < L3GD20_GYRO_NUMBER_OF_AXES; i++) {
     devp->gyrosensitivity[i] = sp[i];
   }
-  return MSG_OK;
+  return msg;
 }
 
 /**