GrowControl/TinkerforgeCPPsimple
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fleshed out IO16-Bricklet.

Browse Source
This commit is contained in:
hg
2014-06-17 01:15:42 +02:00
parent 1768f7b41c
commit 3514bf344b
2 changed files with 190 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
include/tfcppsimple/devices/TfIO16Bricklet.h
+25
View File
@@ -9,10 +9,22 @@
#define TFIO16BRICKLET_H_
#include <tfcppsimple/TfBricklet.h>
#include <bricklet_io16.h>
namespace tfcppsimple {
class TfIO16Bricklet: public TfBricklet {
private:
IO16 ioObj;
uint8_t dirMapA = 0xFF; // 1 .. Eingang, 0 .. Ausgang
uint8_t valueMapA = 0;
uint8_t outMapA = 0;
uint8_t dirMapB = 0xFF; // 1 .. Eingang, 0 .. Ausgang
uint8_t valueMapB = 0;
uint8_t outMapB = 0;
public:
TfIO16Bricklet(TfConnection& connection,
std::string uid,
@@ -25,6 +37,19 @@ public:
virtual ~TfIO16Bricklet();
virtual std::string getDeviceName(bool extended = true);
virtual void doConfigureDevice();
virtual void doReconfigureDevice();
virtual void doConnectionLost();
virtual void doShutdown();
void getPortConfiguration(char port, uint8_t& ret_direction_mask, uint8_t& ret_value_mask);
void setPortConfiguration(char port, uint8_t selection_mask, char direction, bool value);
void setPortConfiguration(char port, uint8_t direction_mask, uint8_t value_mask);
uint8_t getPort(char port);
void setPort(char port, uint8_t value_mask);
void setPort(char port, uint8_t pin_mask, bool value);
};
} /* namespace tfcppsimple */
src/devices/TfIO16Bricklet.cpp
+165
View File
@@ -6,6 +6,7 @@
*/
#include <tfcppsimple/devices/TfIO16Bricklet.h>
#include <tfcppsimple/TfException.h>
namespace tfcppsimple {
@@ -36,4 +37,168 @@ std::string TfIO16Bricklet::getDeviceName(bool extended) {
return ss.str();
}
void TfIO16Bricklet::doConfigureDevice() {
io16_create(&ioObj, uid.c_str(), &connection.getTfIpConnection());
int ret = io16_set_response_expected_all(&ioObj, true);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while configuring: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
} else {
setPortConfiguration('a', dirMapA, valueMapA);
setPort('a', outMapA);
setPortConfiguration('b', dirMapB, valueMapB);
setPort('b', outMapB);
TfDevice::doConfigureDevice();
}
}
void TfIO16Bricklet::doReconfigureDevice() {
io16_destroy(&ioObj);
io16_create(&ioObj, uid.c_str(), &connection.getTfIpConnection());
int ret = io16_set_response_expected_all(&ioObj, true);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while reconfiguring: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
} else {
setPortConfiguration('a', dirMapA, valueMapA);
setPort('a', outMapA);
setPortConfiguration('b', dirMapB, valueMapB);
setPort('b', outMapB);
TfDevice::doReconfigureDevice();
}
}
void TfIO16Bricklet::doConnectionLost() {
TfDevice::doConnectionLost();
}
void TfIO16Bricklet::doShutdown() {
io16_destroy(&ioObj);
TfDevice::doShutdown();
}
void TfIO16Bricklet::getPortConfiguration(char port, uint8_t& ret_direction_mask, uint8_t& ret_value_mask) {
if (port == 'a') {
ret_direction_mask = dirMapA;
ret_value_mask = valueMapA;
} else if (port == 'b') {
ret_direction_mask = dirMapB;
ret_value_mask = valueMapB;
} else {
std::ostringstream ss;
ss << "Unknown Port: " << port << ".";
throw TfError(ss.str(), TfErrorCode::E_INVALID_PARAMETER);
}
}
void TfIO16Bricklet::setPortConfiguration(char port, uint8_t selection_mask, char direction, bool value) {
if (port == 'a') {
dirMapA = (dirMapA & ~selection_mask) | ((direction == 'i' ? 0xFF : 0x00) & selection_mask);
valueMapA = (dirMapA & ~selection_mask) | ((value ? 0xFF : 0x00) & selection_mask);
} else if (port == 'b') {
dirMapB = (dirMapB & ~selection_mask) | ((direction == 'i' ? 0xFF : 0x00) & selection_mask);
valueMapB = (valueMapB & ~selection_mask) | ((value ? 0xFF : 0x00) & selection_mask);
} else {
std::ostringstream ss;
ss << "Unknown Port: " << port << ".";
throw TfError(ss.str(), TfErrorCode::E_INVALID_PARAMETER);
}
int ret = io16_set_port_configuration(&ioObj, port, selection_mask, direction, value);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port configuration: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
void TfIO16Bricklet::setPortConfiguration(char port, uint8_t direction_mask, uint8_t value_mask) {
uint8_t dir;
uint8_t val;
if (port == 'a') {
dir = dirMapA = direction_mask;
val = valueMapA = value_mask;
} else if (port == 'b') {
dir = dirMapB = direction_mask;
val = valueMapB = value_mask;
} else {
std::ostringstream ss;
ss << "Unknown Port: " << port << ".";
throw TfError(ss.str(), TfErrorCode::E_INVALID_PARAMETER);
}
uint8_t mask = dir & val;
if (mask != 0) {
int ret = io16_set_port_configuration(&ioObj, port, mask, 'i', true);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port configuration: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
mask = ~dir & val;
if (mask != 0) {
int ret = io16_set_port_configuration(&ioObj, port, mask, 'o', true);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port configuration: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
mask = dir & ~val;
if (mask != 0) {
int ret = io16_set_port_configuration(&ioObj, port, mask, 'i', false);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port configuration: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
mask = ~dir & ~val;
if (mask != 0) {
int ret = io16_set_port_configuration(&ioObj, port, mask, 'o', false);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port configuration: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
}
uint8_t TfIO16Bricklet::getPort(char port) {
uint8_t retval;
int ret = io16_get_port(&ioObj, port, &retval);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while getting port: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
return retval;
}
void TfIO16Bricklet::setPort(char port, uint8_t value_mask) {
if (port == 'a') {
outMapA = value_mask;
} else if (port == 'b') {
outMapB = value_mask;
} else {
std::ostringstream ss;
ss << "Unknown Port: " << port << ".";
throw TfError(ss.str(), TfErrorCode::E_INVALID_PARAMETER);
}
int ret = io16_set_port(&ioObj, port, value_mask);
if (ret != E_OK) {
std::ostringstream ss;
ss << "Error while setting port: " << ret << ".";
throw TfError(ss.str(), (TfErrorCode)ret);
}
}
void TfIO16Bricklet::setPort(char port, uint8_t pin_mask, bool value) {
throw TfError("Not implemented", TfErrorCode::E_UNKNOWN_ERROR_CODE);
}
} /* namespace tfcppsimple */