alexey.zholtikov/upm
1
0
Fork 0
mirror of https://github.com/eclipse/upm.git synced 2025-03-15 04:57:30 +03:00
Code Issues Actions Packages Projects Releases Wiki Activity

adis16448: 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 15:08:04 -06:00 committed by Mihai Tudor Panu
parent b0ac4b5da2
commit f84973b0e4
1 changed files with 32 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

40
src/adis16448/adis16448.cxx
View File

@ -37,6 +37,8 @@
//
//////////////////////////////////////////////////////////////////////////////////////
#include <iostream>
#include <string>
#include <stdexcept>
#include <unistd.h>
#include <stdlib.h>
#include <functional>
@ -54,14 +56,23 @@ using namespace upm;
ADIS16448::ADIS16448(int bus, int rst)
{
// Configure I/O
_rst = mraa_gpio_init(rst); //Initialize RST pin
//Initialize RST pin
if ( !(_rst = mraa_gpio_init(rst)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_gpio_init() failed, invalid pin?");
return;
}
mraa_gpio_dir(_rst, MRAA_GPIO_IN); //Set direction as INPUT
// Configure SPI
_spi = mraa_spi_init(bus);
mraa_spi_frequency(_spi, 1000000); //Set SPI frequency to 1MHz
mraa_spi_mode(_spi, MRAA_SPI_MODE3); //Set SPI mode/polarity
mraa_spi_bit_per_word(_spi, 16); //Set # of bits per word
// Configure SPI
if ( !(_spi = mraa_spi_init(bus)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_spi_init() failed");
return;
}
configSPI();
}
////////////////////////////////////////////////////////////////////////////
@ -102,8 +113,21 @@ void ADIS16448::resetDUT()
////////////////////////////////////////////////////////////////////////////
void ADIS16448::configSPI() {
mraa_spi_frequency(_spi, 1000000); //Set SPI frequency to 1MHz
mraa_spi_mode(_spi, MRAA_SPI_MODE3); //Set SPI mode/polarity
mraa_spi_bit_per_word(_spi, 16); //Set # of bits per word
if ( mraa_spi_mode(_spi, MRAA_SPI_MODE3) != MRAA_SUCCESS )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_spi_mode() failed");
return;
}
//Set # of bits per word
if ( mraa_spi_bit_per_word(_spi, 16) != MRAA_SUCCESS )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_spi_bit_per_word() failed");
return;
}
}
////////////////////////////////////////////////////////////////////////////////////////////