aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_HAL_Linux: take the semaphore in SPIUARTDriver for shorter periods of time

Browse Source
This commit is contained in:
Staroselskii Georgii 2015-02-03 18:41:41 +03:00 committed by Andrew Tridgell
parent 64da7f0360
commit 195aa5fc6b
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_HAL_Linux/SPIUARTDriver.cpp
View File

@ -112,6 +112,8 @@ int LinuxSPIUARTDriver::_write_fd(const uint8_t *buf, uint16_t size)
_spi->transaction(buf, _buffer, size);
sem_give();
BUF_ADVANCEHEAD(_writebuf, size);
uint16_t ret = size;
@ -128,7 +130,6 @@ int LinuxSPIUARTDriver::_write_fd(const uint8_t *buf, uint16_t size)
space = BUF_SPACE(_readbuf);
if (space == 0) {
sem_give();
return ret;
}
@ -141,7 +142,6 @@ int LinuxSPIUARTDriver::_write_fd(const uint8_t *buf, uint16_t size)
assert(_readbuf_tail+size <= _readbuf_size);
memcpy(&_readbuf[_readbuf_tail], buffer, size);
BUF_ADVANCETAIL(_readbuf, size);
sem_give();
return ret;
}
@ -159,7 +159,6 @@ int LinuxSPIUARTDriver::_write_fd(const uint8_t *buf, uint16_t size)
BUF_ADVANCETAIL(_readbuf, n);
}
sem_give();
return ret;