lauchmelder/b15f
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

remote set and get register by address

Browse source
This commit is contained in:
Tristan Krause 2019-05-29 10:13:36 +02:00
parent 2c47159df3
commit 2e88b9c980
69 changed files with 1595 additions and 117 deletions
Download patch file Download diff file Expand all files Collapse all files

40
control/src/drv/b15f.cpp
View file

@ -330,6 +330,46 @@ bool B15F::pwmSetValue(uint8_t value)
return aw == MSG_OK;
}
bool B15F::setRegister(uint8_t adr, uint8_t val)
{
usart.clearInputBuffer();
uint8_t rq[] =
{
RQ_SET_REG,
adr,
val
};
int n_sent = usart.write_timeout(&rq[0], 0, sizeof(rq), 1000);
if(n_sent != sizeof(rq))
abort("Sent failed");
uint8_t byte = usart.readByte();
delay_us(10);
return byte == val;
}
uint8_t B15F::getRegister(uint8_t adr)
{
usart.clearInputBuffer();
uint8_t rq[] =
{
RQ_GET_REG,
adr
};
int n_sent = usart.write_timeout(&rq[0], 0, sizeof(rq), 1000);
if(n_sent != sizeof(rq))
abort("Sent failed");
uint8_t aw = usart.readByte();
delay_us(10);
return aw;
}
void B15F::delay_ms(uint16_t ms)
{
std::this_thread::sleep_for(std::chrono::milliseconds(ms));