GY-63_MS5611/libraries/PinOutGroup/PinOutGroup.cpp
2021-01-29 12:31:58 +01:00

153 lines
2.8 KiB
C++

//
// FILE: PinOutGroup.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.1.3
// DATE: 2017-04-26
// PURPOSE: PinOutGroup library for Arduino
// goal is to easily change a group of pins that logically
// belong to each other e.g. 8 data pins of a parallel printer.
// these pins can be in any order.
// URL: https://github.com/RobTillaart/PinOutGroup
// http://forum.arduino.cc/index.php?topic=469599.0
//
// HISTORY
//
// 0.1.0 20-08-2017 initial version (based upon experimental pinGroup)
// 0.1.1 2020-05-19 main refactor;
// added tests; added clear(); added write(idx, value)
// renamed set to write() to be in line with digitalWrite()
// 0.1.2 2020-06-19 fix library.json
// 0.1.3 2021-01-05 add Arduino-CI + unit test
#include "PinOutGroup.h"
PinOutGroup::PinOutGroup()
{
clear();
}
void PinOutGroup::clear()
{
// safety: set all to LOW before cleaning up.
allLOW();
_size = 0;
}
uint8_t PinOutGroup::add(uint8_t sz, uint8_t* ar, uint8_t value)
{
int n = 0;
for (uint8_t i = 0; i < sz; i++)
{
n += add(ar[i], value);
}
return n;
}
uint8_t PinOutGroup::add(uint8_t pin, uint8_t value)
{
if (_size >= PINOUTGROUP_MAXSIZE) return 0;
_pins[_size] = pin;
pinMode(pin, OUTPUT);
write(_size, value); // takes care of _lastValue
_size++;
return 1;
}
uint8_t PinOutGroup::isInGroup(uint8_t pin)
{
uint8_t count = 0;
for (uint8_t i = 0; i < _size; i++)
{
if (_pins[i] == pin) count++;
}
return count;
}
uint8_t PinOutGroup::write(uint16_t value)
{
uint16_t changed = _lastValue ^ value; // detect pins that changed
if (changed == 0) return 0;
uint16_t bitMask = 1;
uint8_t changeCount = 0;
for (uint8_t i = 0; i < _size; i++)
{
if ((changed & bitMask) > 0)
{
digitalWrite(_pins[i], (value & bitMask) > 0);
changeCount++;
}
bitMask <<= 1;
}
_lastValue = value;
return changeCount;
}
uint8_t PinOutGroup::write(uint8_t idx, uint8_t value)
{
if (idx >= _size) return 0;
uint16_t mask = (1 << idx);
uint16_t lv = _lastValue & mask;
if ((value > 0) == (lv > 0)) return 0; // no change
digitalWrite(_pins[idx], value);
if (value == LOW) _lastValue &= ~mask;
else _lastValue |= mask;
return 1;
}
void PinOutGroup::allLOW()
{
for (uint8_t i = 0; i < _size; i++)
{
digitalWrite(_pins[i], LOW);
}
_lastValue = 0;
}
void PinOutGroup::allHIGH()
{
uint16_t value = 0;
for (uint8_t i = 0; i < _size; i++)
{
digitalWrite(_pins[i], HIGH);
value = (1 << i); // set flags.
}
_lastValue = value;
}
uint8_t PinOutGroup::getPin(uint8_t idx)
{
if (idx >= _size) return 0xFF;
return _pins[idx];
}
uint8_t PinOutGroup::getIdx(uint8_t pin)
{
for (uint8_t i = 0; i < _size; i++)
{
if (_pins[i] == pin) return i;
}
return 0xFF;
}
// --- END OF FILE ---