From 5ec8f226d9a38a0d89abfe399a87dccd9ffd1a84 Mon Sep 17 00:00:00 2001
From: J3RN <j3rn@j3rn.com>
Date: Thu, 25 Jul 2013 09:45:30 -0400
Subject: [PATCH] Fixed and tested through high pass filter frequency cut off
 level

---
 Arduino/L3G4200D/L3G4200D.cpp | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

diff --git a/Arduino/L3G4200D/L3G4200D.cpp b/Arduino/L3G4200D/L3G4200D.cpp
index 5988681f..9f7cae3b 100644
--- a/Arduino/L3G4200D/L3G4200D.cpp
+++ b/Arduino/L3G4200D/L3G4200D.cpp
@@ -339,8 +339,9 @@ void L3G4200D::setHighPassMode(uint8_t mode) {
  * @see L3G4200D_HPM_AUTORESET
  */
 uint8_t L3G4200D::getHighPassMode() {
-	return I2Cdev::readBits(devAddr, L3G4200D_RA_CTRL_REG2, L3G4200D_HPM_BIT, 
+	I2Cdev::readBits(devAddr, L3G4200D_RA_CTRL_REG2, L3G4200D_HPM_BIT, 
 		L3G4200D_HPM_LENGTH, buffer);
+	return buffer[0];
 }
 
 /** Set the high pass filter cut off frequency level (1 - 10)
@@ -381,8 +382,9 @@ void L3G4200D::setHighPassFilterCutOffFrequencyLevel(uint8_t level) {
  * @see L3G4200D_HPCF10
  */
 uint8_t L3G4200D::getHighPassFilterCutOffFrequencyLevel() {
-	return I2Cdev::readBits(devAddr, L3G4200D_RA_CTRL_REG2, L3G4200D_HPCF_BIT, 
+	I2Cdev::readBits(devAddr, L3G4200D_RA_CTRL_REG2, L3G4200D_HPCF_BIT, 
 		L3G4200D_HPCF_LENGTH, buffer);
+	return buffer[0];
 }
 
 // CTRL_REG3 register, r/w