39 lines
624 B
C++
39 lines
624 B
C++
|
#include "MyLcd.h"
|
||
|
|
#include "Hardware.h"
|
||
|
|
|
||
|
|
void MyLcd::execute(const Command &cmd, bool RS, double delay)
|
||
|
|
{
|
||
|
|
static const uint8_t eMask = 0b00000010;
|
||
|
|
static const uint8_t rsMask = 0b01000000;
|
||
|
|
//static const double pulseLength = 0.5;
|
||
|
|
|
||
|
|
{
|
||
|
|
uint8_t output = (cmd.data & 0xf0) >> 2;
|
||
|
|
if (RS)
|
||
|
|
{
|
||
|
|
output |= rsMask;
|
||
|
|
}
|
||
|
|
|
||
|
|
m_lcdShiftReg.set(output | eMask);
|
||
|
|
//delay_us(pulseLength);
|
||
|
|
m_lcdShiftReg.set(output);
|
||
|
|
}
|
||
|
|
|
||
|
|
{
|
||
|
|
uint8_t output = (cmd.data & 0x0f) << 2;
|
||
|
|
if (RS)
|
||
|
|
{
|
||
|
|
output |= rsMask;
|
||
|
|
}
|
||
|
|
|
||
|
|
m_lcdShiftReg.set(output | eMask);
|
||
|
|
//delay_us(pulseLength);
|
||
|
|
m_lcdShiftReg.set(output);
|
||
|
|
}
|
||
|
|
|
||
|
|
delay_ms(delay);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|