Skip to content
Snippets Groups Projects
Commit 3c36a615 authored by Lorenz Meier's avatar Lorenz Meier
Browse files

Merge pull request #2017 from UAVenture/sf02_fix

Store the port so the in use port will be referenced when reopening.
parents ac6ffd36 8fd6b3da
No related branches found
No related tags found
No related merge requests found
......@@ -114,6 +114,7 @@ protected:
virtual int probe();
private:
char _port[20];
float _min_distance;
float _max_distance;
work_s _work;
......@@ -199,8 +200,13 @@ SF0X::SF0X(const char *port) :
_comms_errors(perf_alloc(PC_COUNT, "sf0x_comms_errors")),
_buffer_overflows(perf_alloc(PC_COUNT, "sf0x_buffer_overflows"))
{
/* store port name */
strncpy(_port, port, sizeof(_port));
/* enforce null termination */
_port[sizeof(_port) - 1] = '\0';
/* open fd */
_fd = ::open(port, O_RDWR | O_NOCTTY | O_NONBLOCK);
_fd = ::open(_port, O_RDWR | O_NOCTTY | O_NONBLOCK);
if (_fd < 0) {
warnx("FAIL: laser fd");
......@@ -633,7 +639,7 @@ SF0X::cycle()
/* fds initialized? */
if (_fd < 0) {
/* open fd */
_fd = ::open(SF0X_DEFAULT_PORT, O_RDWR | O_NOCTTY | O_NONBLOCK);
_fd = ::open(_port, O_RDWR | O_NOCTTY | O_NONBLOCK);
}
/* collection phase? */
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment