alexey.zholtikov/upm
1
0
Fork 0
mirror of https://github.com/eclipse/upm.git synced 2025-03-24 01:10:22 +03:00
Code Issues Actions Packages Projects Releases Wiki Activity

hmc5883l: throw exception(s) on fatal errors

Browse Source 
Signed-off-by: Jon Trulson <jtrulson@ics.com>
Signed-off-by: Mihai Tudor Panu <mihai.tudor.panu@intel.com>
This commit is contained in:
Jon Trulson 2015-09-09 11:13:15 -06:00 committed by Mihai Tudor Panu
parent 9e3c72a547
commit 88c11fb1cf
1 changed files with 28 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
src/hmc5883l/hmc5883l.cxx
View File

@ -23,6 +23,9 @@
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*/ */
#include <string>
#include <stdexcept>
#include "math.h" #include "math.h"
#include "hmc5883l.h" #include "hmc5883l.h"
@ -80,15 +83,36 @@ using namespace upm;
Hmc5883l::Hmc5883l(int bus) : m_i2c(bus) Hmc5883l::Hmc5883l(int bus) : m_i2c(bus)
{ {
m_i2c.address(HMC5883L_I2C_ADDR); mraa::Result error;
error = m_i2c.address(HMC5883L_I2C_ADDR);
if(error != mraa::SUCCESS){
throw std::invalid_argument(std::string(__FUNCTION__) +
": i2c.address() failed");
return;
}
m_rx_tx_buf[0] = HMC5883L_CONF_REG_B; m_rx_tx_buf[0] = HMC5883L_CONF_REG_B;
m_rx_tx_buf[1] = GA_1_3_REG; m_rx_tx_buf[1] = GA_1_3_REG;
m_i2c.write(m_rx_tx_buf, 2); error = m_i2c.write(m_rx_tx_buf, 2);
if(error != mraa::SUCCESS){
throw std::runtime_error(std::string(__FUNCTION__) +
": i2c.write() configuration failed");
return;
}
m_i2c.address(HMC5883L_I2C_ADDR); error = m_i2c.address(HMC5883L_I2C_ADDR);
if(error != mraa::SUCCESS){
throw std::invalid_argument(std::string(__FUNCTION__) +
": i2c.address() failed");
return;
}
m_rx_tx_buf[0] = HMC5883L_MODE_REG; m_rx_tx_buf[0] = HMC5883L_MODE_REG;
m_rx_tx_buf[1] = HMC5883L_CONT_MODE; m_rx_tx_buf[1] = HMC5883L_CONT_MODE;
m_i2c.write(m_rx_tx_buf, 2); error = m_i2c.write(m_rx_tx_buf, 2);
if(error != mraa::SUCCESS){
throw std::runtime_error(std::string(__FUNCTION__) +
": i2c.write() mode failed");
return;
}
Hmc5883l::update(); Hmc5883l::update();
} }