Browse Source

sf0x.cpp: change baudrate to 115200 for SF11/C

sbg
Burak Han 6 years ago committed by Beat Küng
parent
commit
d2a0c857ed
No known key found for this signature in database
GPG Key ID: 866DB5F0E24821BB
  1. 14
      src/drivers/distance_sensor/sf0x/sf0x.cpp

14
src/drivers/distance_sensor/sf0x/sf0x.cpp

@ -590,7 +590,19 @@ SF0X::cycle() @@ -590,7 +590,19 @@ SF0X::cycle()
/* no parity, one stop bit */
uart_config.c_cflag &= ~(CSTOPB | PARENB);
unsigned speed = B9600;
/* if distance sensor model is SF11/C, then set baudrate 115200, else 9600 */
int hw_model;
param_get(param_find("SENS_EN_SF0X"), &hw_model);
unsigned speed;
if (hw_model == 5) {
speed = B115200;
} else {
speed = B9600;
}
/* set baud rate */
if ((termios_state = cfsetispeed(&uart_config, speed)) < 0) {

Loading…
Cancel
Save