VSAG/vision_sjtu_19
3
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

energy changed

Browse Source
This commit is contained in:
sun
2019-07-12 22:52:18 +08:00
parent 89e07615aa
commit f40bfbf5d2
1 changed files with 151 additions and 146 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
others/src/serial/serial.cpp
View File

@@ -227,6 +227,7 @@ bool Serial::InitPort(int nSpeed, char nEvent, int nBits, int nStop){
bool Serial::WriteData(const unsigned char *pData, unsigned int length) { bool Serial::WriteData(const unsigned char *pData, unsigned int length) {
int cnt = 0, curr = 0; int cnt = 0, curr = 0;
if (fd <= 0)return false;
while ((curr = write(fd, pData + cnt, length - cnt)) > 0 && (cnt += curr) < length); while ((curr = write(fd, pData + cnt, length - cnt)) > 0 && (cnt += curr) < length);
if (cnt < 0) { if (cnt < 0) {
LOGE("Serial offline!"); LOGE("Serial offline!");
@@ -265,10 +266,13 @@ int Serial::set_opt(int fd, int nSpeed, char nEvent, int nBits, int nStop) {
switch (nBits) { switch (nBits) {
case 7: case 7:
newtio.c_cflag |= CS7;break; newtio.c_cflag |= CS7;
break;
case 8: case 8:
newtio.c_cflag |= CS8;break; newtio.c_cflag |= CS8;
default:break; break;
default:
break;
} }
switch (nEvent) { switch (nEvent) {
@@ -285,7 +289,8 @@ int Serial::set_opt(int fd, int nSpeed, char nEvent, int nBits, int nStop) {
case 'N': //无校验 case 'N': //无校验
newtio.c_cflag &= ~PARENB; newtio.c_cflag &= ~PARENB;
break; break;
default:break; default:
break;
} }
switch (nSpeed) { switch (nSpeed) {