GY-63_MS5611/libraries/TLC5947/TLC5947.cpp
2023-11-22 17:13:58 +01:00

157 lines
3.0 KiB
C++

//
// FILE: TLC5947.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.1.2
// DATE: 2023-06-17
// PURPOSE: Arduino library for the TLC5947 24 channel PWM device
// URL: https://github.com/RobTillaart/TLC5947
#include "TLC5947.h"
TLC5947::TLC5947(uint8_t clock, uint8_t data, uint8_t latch, uint8_t blank)
{
_clock = clock;
_data = data;
_latch = latch;
_blank = blank;
_buffer = (uint16_t *) calloc(24, 2);
}
TLC5947::~TLC5947()
{
if(_buffer) free(_buffer);
}
bool TLC5947::begin()
{
pinMode(_clock, OUTPUT);
pinMode(_data, OUTPUT);
pinMode(_latch, OUTPUT);
pinMode(_blank, OUTPUT);
digitalWrite(_clock, LOW);
digitalWrite(_data, LOW);
digitalWrite(_latch, LOW);
digitalWrite(_blank, HIGH); // enable PWM mode
return true;
}
bool TLC5947::setPWM(uint8_t channel, uint16_t PWM)
{
if (channel >= 24) return false;
_buffer[channel] = PWM > 4095 ? 4095 : PWM;
return true;
}
uint16_t TLC5947::getPWM(uint8_t channel)
{
if (channel >= 24) return TLC5947_CHANNEL_ERROR;
return _buffer[channel] & 0x0FFF;
}
void TLC5947::setAll(uint16_t PWM)
{
uint16_t pwm = PWM > 4095 ? 4095 : PWM;
for (int chan = 0; chan < 24; chan++)
{
_buffer[chan] = pwm;
}
write();
}
bool TLC5947::setPercentage(uint8_t channel, float perc)
{
if (perc < 0) perc = 0;
return setPWM(channel, round(perc * 40.95));
}
void TLC5947::setPercentageAll(float perc)
{
if (perc < 0) perc = 0;
setAll(round(perc * 40.95));
}
float TLC5947::getPercentage(uint8_t channel)
{
return getPWM(channel) * (100.0 / 4095);
}
void TLC5947::write()
{
#if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR)
// register level optimized AVR
uint8_t port = digitalPinToPort(_data);
volatile uint8_t *_dataOutRegister = portOutputRegister(port);
uint8_t outmask1 = digitalPinToBitMask(_data);
uint8_t outmask2 = ~outmask1;
port = digitalPinToPort(_clock);
volatile uint8_t *_clockRegister = portOutputRegister(port);
uint8_t cbmask1 = digitalPinToBitMask(_clock);
uint8_t cbmask2 = ~cbmask1;
for (int chan = 23; chan >= 0; chan--)
{
for (int mask = 0x1000; mask; mask >>= 1)
{
*_clockRegister &= cbmask2;
if (_buffer[chan] & mask) *_dataOutRegister |= outmask1;
else *_dataOutRegister &= outmask2;
*_clockRegister |= cbmask1;
}
}
*_clockRegister &= cbmask2;
#else
// also write when blank == LOW
// to "preload the registers"
// local vars to maximize speed.
uint8_t _clk = _clock;
uint8_t _dat = _data;
for (int chan = 23; chan >= 0; chan--)
{
for (int mask = 0x1000; mask; mask >>= 1)
{
digitalWrite(_clk, LOW);
digitalWrite(_dat, _buffer[chan] & mask ? HIGH : LOW);
digitalWrite(_clk, HIGH);
}
}
digitalWrite(_clk, LOW);
#endif
// enable
digitalWrite(_latch, HIGH);
digitalWrite(_latch, LOW);
}
void TLC5947::enable()
{
digitalWrite(_blank, HIGH);
}
void TLC5947::disable()
{
digitalWrite(_blank, LOW);
}
// -- END OF FILE --