ModelTrain/TrainDecoder
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Only act if 2 packets with the same data are recived

Browse source
This commit is contained in:
uvos 2022-01-27 20:14:44 +01:00
parent 783fc72004
commit 7377a6081c
1 changed files with 46 additions and 13 deletions
Download patch file Download diff file Expand all files Collapse all files

41
main.cpp
View file

@ -14,26 +14,56 @@ static constexpr uint8_t T1_B = PB4;
static volatile bool turnout0Flag = false;
static volatile bool turnout1Flag = false;
uint16_t oldData = 0;
constexpr bool debug = false;
void handler(uint16_t data, void *user_data)
{
(void)user_data;
if constexpr(debug)
{
writePin(&PORTB, T0_A, false);
_delay_ms(1);
for(uint8_t i = 0; i < 10; ++i)
{
writePin(&PORTB, T0_A, true);
_delay_us(25);
if(data & (1 << (9-i)))
_delay_us(75);
writePin(&PORTB, T0_A, false);
_delay_us(25);
if(!(data & (1 << (9-i))))
_delay_us(75);
}
}
if(data == oldData)
{
if(((bool)(data & (1 << 9))) != ((bool)(data & (1 << 8))) ||
((bool)(data & (1 << 7))) != ((bool)(data & (1 << 6))) ||
((bool)(data & (1 << 5))) != ((bool)(data & (1 << 4))))
return;
bool set = data & (1 << 9);
if(data & (1 << 7))
turnout0Flag = set;
if(data & (1 << 5))
turnout1Flag = set;
}
else
{
oldData = data;
}
}
static void setTurnout0(bool in)
{
writePin(&PORTB, T0_A, in);
writePin(&PORTB, T0_B, !in);
_delay_ms(50);
_delay_ms(150);
writePin(&PORTB, T0_A, false);
writePin(&PORTB, T0_B, false);
@ -44,13 +74,13 @@ static void setTurnout1(bool in)
{
writePin(&PORTB, T1_A, in);
writePin(&PORTB, T1_B, !in);
_delay_ms(50);
_delay_ms(150);
writePin(&PORTB, T1_A, false);
writePin(&PORTB, T1_B, false);
}
Decoder decoder(&PINB, PB2, &TCNT1, &handler, nullptr, 0x02);
Decoder decoder(&PINB, PB2, &TCNT1, &handler, nullptr, 0x01);
ISR(TIMER1_OVF_vect)
{
@ -59,13 +89,16 @@ ISR(TIMER1_OVF_vect)
ISR(INT0_vect)
{
if constexpr(debug)
{
writePin(&PORTB, T1_A, !readPin(&PORTB, T1_A));
}
decoder.interrupt();
}
int main()
{
DDRB = (1 << PB0) | (1 << PB1) | (1 << PB3) | (1 << PB4);
bool turnout0 = turnout0Flag;
bool turnout1 = turnout1Flag;
_delay_ms(100);