mirror of
https://github.com/eclipse/upm.git
synced 2025-03-17 22:17:28 +03:00
106 lines
2.4 KiB
C++
106 lines
2.4 KiB
C++
/*
|
|
* Author: Jon Trulson <jtrulson@ics.com>
|
|
* Copyright (c) 2016 Intel Corporation.
|
|
*
|
|
* This program and the accompanying materials are made available under the
|
|
* terms of the The MIT License which is available at
|
|
* https://opensource.org/licenses/MIT.
|
|
*
|
|
* SPDX-License-Identifier: MIT
|
|
*/
|
|
|
|
#include <unistd.h>
|
|
#include <iostream>
|
|
#include <stdexcept>
|
|
#include <string>
|
|
|
|
#include "ms5803.hpp"
|
|
|
|
using namespace upm;
|
|
using namespace std;
|
|
|
|
MS5803::MS5803(int bus, int address, int csPin) :
|
|
m_ms5803(ms5803_init(bus, address, csPin))
|
|
{
|
|
if (!m_ms5803)
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_init() failed");
|
|
}
|
|
|
|
MS5803::~MS5803()
|
|
{
|
|
ms5803_close(m_ms5803);
|
|
}
|
|
|
|
void MS5803::update()
|
|
{
|
|
if (ms5803_update(m_ms5803))
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_update() failed");
|
|
}
|
|
|
|
void MS5803::reset()
|
|
{
|
|
if (ms5803_reset(m_ms5803))
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_reset() failed");
|
|
}
|
|
|
|
void MS5803::setTemperatureOSR(MS5803_OSR_T osr)
|
|
{
|
|
ms5803_set_temperature_osr(m_ms5803, osr);
|
|
}
|
|
|
|
void MS5803::setPressureOSR(MS5803_OSR_T osr)
|
|
{
|
|
ms5803_set_pressure_osr(m_ms5803, osr);
|
|
}
|
|
|
|
|
|
float MS5803::getTemperature()
|
|
{
|
|
return ms5803_get_temperature(m_ms5803);
|
|
}
|
|
|
|
float MS5803::getPressure()
|
|
{
|
|
return (ms5803_get_pressure(m_ms5803) * 100);
|
|
}
|
|
|
|
void MS5803::loadCoefficients()
|
|
{
|
|
if (ms5803_load_coefficients(m_ms5803))
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_load_coefficients() failed");
|
|
}
|
|
|
|
string MS5803::busRead(int cmd, int len)
|
|
{
|
|
uint8_t ucmd = (uint8_t)(cmd & 0xff);
|
|
uint8_t ulen = (uint8_t)(len & 0xff);
|
|
|
|
uint8_t *data = new uint8_t[ulen];
|
|
|
|
if (ms5803_bus_read(m_ms5803, ucmd, data, ulen))
|
|
{
|
|
delete [] data;
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_bus_read() failed");
|
|
}
|
|
|
|
string dataStr((char *)data, ulen);
|
|
delete [] data;
|
|
|
|
return dataStr;
|
|
}
|
|
|
|
void MS5803::busWrite(int cmd, string data)
|
|
{
|
|
uint8_t ucmd = (uint8_t)(cmd & 0xff);
|
|
|
|
if (ms5803_bus_write(m_ms5803, ucmd, (uint8_t *)data.data(),
|
|
(uint8_t)data.size()))
|
|
throw std::runtime_error(string(__FUNCTION__)
|
|
+ ": ms5803_bus_write() failed");
|
|
}
|