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

bitmuster angepasst

Browse source
This commit is contained in:
Tristan Krause 2019-06-21 15:42:25 +02:00
parent 8b12507c3b
commit 5401635968
4 changed files with 24 additions and 23 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -135,6 +135,13 @@ void B15F::delay_us(uint16_t us)
std::this_thread::sleep_for(std::chrono::microseconds(us));
}
void B15F::reverse(uint8_t& b)
{
b = (b & 0xF0) >> 4 | (b & 0x0F) << 4;
b = (b & 0xCC) >> 2 | (b & 0x33) << 2;
b = (b & 0xAA) >> 1 | (b & 0x55) << 1;
}
// https://stackoverflow.com/a/478960
std::string B15F::exec(std::string cmd)
{
@ -197,10 +204,7 @@ bool B15F::activateSelfTestMode()
}
bool B15F::digitalWrite0(uint8_t port)
{
reverse(port);
{
uint8_t rq[] =
{
RQ_DIGITAL_WRITE_0,
@ -215,9 +219,6 @@ bool B15F::digitalWrite0(uint8_t port)
bool B15F::digitalWrite1(uint8_t port)
{
reverse(port);
uint8_t rq[] =
{
RQ_DIGITAL_WRITE_1,
@ -269,6 +270,9 @@ uint8_t B15F::readDipSwitch()
uint8_t aw;
usart.receive(&aw, 0, sizeof(aw));
reverse(aw); // DIP Schalter muss invertiert werden!
return aw;
}
@ -512,10 +516,3 @@ void B15F::init()
std::cout << PRE << "AVR Firmware Version: " << info[0] << " um " << info[1] << " Uhr (" << info[2] << ")"
<< std::endl;
}
void B15F::reverse(uint8_t& b)
{
b = (b & 0xF0) >> 4 | (b & 0x0F) << 4;
b = (b & 0xCC) >> 2 | (b & 0x33) << 2;
b = (b & 0xAA) >> 1 | (b & 0x55) << 1;
}