Skip to content
Projects
Groups
Snippets
Help
Loading...
Help
Support
Submit feedback
Contribute to GitLab
Sign in
Toggle navigation
Q
qgroundcontrol
Project
Project
Details
Activity
Releases
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
0
Issues
0
List
Boards
Labels
Milestones
Merge Requests
0
Merge Requests
0
CI / CD
CI / CD
Pipelines
Jobs
Schedules
Charts
Wiki
Wiki
Snippets
Snippets
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Open sidebar
Valentin Platzgummer
qgroundcontrol
Commits
f2011b30
Commit
f2011b30
authored
Apr 20, 2016
by
Beat Küng
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
GPSProvider: retry a few times before giving up when we get an error from the driver
This also replaces tabs with spaces
parent
795d48d2
Changes
1
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
40 additions
and
28 deletions
+40
-28
GPSProvider.cc
src/GPS/GPSProvider.cc
+40
-28
No files found.
src/GPS/GPSProvider.cc
View file @
f2011b30
...
...
@@ -51,37 +51,49 @@ void GPSProvider::run()
unsigned
int
baudrate
;
GPSHelper
*
gpsHelper
=
nullptr
;
while
(
!
_requestStop
)
{
while
(
!
_requestStop
)
{
if
(
gpsHelper
)
{
delete
gpsHelper
;
gpsHelper
=
nullptr
;
}
if
(
gpsHelper
)
{
delete
gpsHelper
;
gpsHelper
=
nullptr
;
}
gpsHelper
=
new
GPSDriverUBX
(
&
callbackEntry
,
this
,
&
_reportGpsPos
,
_pReportSatInfo
);
gpsHelper
=
new
GPSDriverUBX
(
&
callbackEntry
,
this
,
&
_reportGpsPos
,
_pReportSatInfo
);
if
(
gpsHelper
->
configure
(
baudrate
,
GPSHelper
::
OutputMode
::
RTCM
)
==
0
)
{
if
(
gpsHelper
->
configure
(
baudrate
,
GPSHelper
::
OutputMode
::
RTCM
)
==
0
)
{
/* reset report */
memset
(
&
_reportGpsPos
,
0
,
sizeof
(
_reportGpsPos
));
/* reset report */
memset
(
&
_reportGpsPos
,
0
,
sizeof
(
_reportGpsPos
));
int
helperRet
;
//In rare cases it can happen that we get an error from the driver (eg. checksum failure) due to
//bus errors or buggy firmware. In this case we want to try multiple times before giving up.
int
numTries
=
0
;
while
((
helperRet
=
gpsHelper
->
receive
(
TIMEOUT_5HZ
))
>
0
&&
!
_requestStop
)
{
while
(
!
_requestStop
&&
numTries
<
3
)
{
int
helperRet
=
gpsHelper
->
receive
(
TIMEOUT_5HZ
);
if
(
helperRet
&
1
)
{
publishGPSPosition
();
}
if
(
helperRet
>
0
)
{
numTries
=
0
;
if
(
_pReportSatInfo
&&
(
helperRet
&
2
))
{
publishGPSSatellite
();
}
}
if
(
_serial
->
error
()
!=
QSerialPort
::
NoError
)
{
break
;
}
}
}
qDebug
()
<<
"Exiting GPS thread"
;
if
(
helperRet
&
1
)
{
publishGPSPosition
();
numTries
=
0
;
}
if
(
_pReportSatInfo
&&
(
helperRet
&
2
))
{
publishGPSSatellite
();
numTries
=
0
;
}
}
else
{
++
numTries
;
}
}
if
(
_serial
->
error
()
!=
QSerialPort
::
NoError
&&
_serial
->
error
()
!=
QSerialPort
::
TimeoutError
)
{
break
;
}
}
}
qDebug
()
<<
"Exiting GPS thread"
;
}
GPSProvider
::
GPSProvider
(
const
QString
&
device
,
bool
enableSatInfo
,
const
std
::
atomic_bool
&
requestStop
)
...
...
@@ -118,13 +130,13 @@ void GPSProvider::gotRTCMData(uint8_t* data, size_t len)
int
GPSProvider
::
callbackEntry
(
GPSCallbackType
type
,
void
*
data1
,
int
data2
,
void
*
user
)
{
GPSProvider
*
gps
=
(
GPSProvider
*
)
user
;
return
gps
->
callback
(
type
,
data1
,
data2
);
GPSProvider
*
gps
=
(
GPSProvider
*
)
user
;
return
gps
->
callback
(
type
,
data1
,
data2
);
}
int
GPSProvider
::
callback
(
GPSCallbackType
type
,
void
*
data1
,
int
data2
)
{
switch
(
type
)
{
switch
(
type
)
{
case
GPSCallbackType
:
:
readDeviceData
:
{
int
timeout
=
*
((
int
*
)
data1
);
if
(
!
_serial
->
waitForReadyRead
(
timeout
))
...
...
@@ -159,5 +171,5 @@ int GPSProvider::callback(GPSCallbackType type, void *data1, int data2)
break
;
}
return
0
;
return
0
;
}
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment