From 8b32e5715ec1c99b5407f582551cc88975d2a001 Mon Sep 17 00:00:00 2001 From: Rocco Marco Guglielmi Date: Wed, 9 Mar 2016 13:17:36 +0000 Subject: fixed read_raw() git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9056 35acf78f-673a-0410-8e92-d51de3d6d3f4 --- os/ex/ST/l3gd20.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) (limited to 'os/ex') diff --git a/os/ex/ST/l3gd20.c b/os/ex/ST/l3gd20.c index 3ed48ecf3..07b9b8a32 100644 --- a/os/ex/ST/l3gd20.c +++ b/os/ex/ST/l3gd20.c @@ -220,9 +220,9 @@ static msg_t read_raw(void *ip, int32_t axes[L3GD20_NUMBER_OF_AXES]) { } if(((L3GD20Driver *)ip)->config->axesenabling & L3GD20_AE_Z){ axes[2] = (int16_t)(l3gd20SPIReadRegister(((L3GD20Driver *)ip)->config->spip, - L3GD20_AD_OUT_Y_L)); + L3GD20_AD_OUT_Z_L)); axes[2] += (int16_t)(l3gd20SPIReadRegister(((L3GD20Driver *)ip)->config->spip, - L3GD20_AD_OUT_Y_H) << 8); + L3GD20_AD_OUT_Z_H) << 8); axes[2] -= ((L3GD20Driver *)ip)->bias[2]; } #if L3GD20_SHARED_SPI -- cgit v1.2.3