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
95533db6
Commit
95533db6
authored
Jul 27, 2011
by
LM
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
More debug output removed, trying to fix some threading issues on application shutdown
parent
ca34e389
Changes
3
Hide whitespace changes
Inline
Side-by-side
Showing
3 changed files
with
26 additions
and
26 deletions
+26
-26
UASWaypointManager.cc
src/uas/UASWaypointManager.cc
+21
-21
HUD.cc
src/ui/HUD.cc
+2
-2
WaypointView.cc
src/ui/WaypointView.cc
+3
-3
No files found.
src/uas/UASWaypointManager.cc
View file @
95533db6
...
@@ -57,7 +57,7 @@ void UASWaypointManager::timeout()
...
@@ -57,7 +57,7 @@ void UASWaypointManager::timeout()
protocol_timer
.
start
(
PROTOCOL_TIMEOUT_MS
);
protocol_timer
.
start
(
PROTOCOL_TIMEOUT_MS
);
current_retries
--
;
current_retries
--
;
emit
updateStatusString
(
tr
(
"Timeout, retrying (retries left: %1)"
).
arg
(
current_retries
));
emit
updateStatusString
(
tr
(
"Timeout, retrying (retries left: %1)"
).
arg
(
current_retries
));
qDebug
()
<<
"Timeout, retrying (retries left:"
<<
current_retries
<<
")"
;
//
qDebug() << "Timeout, retrying (retries left:" << current_retries << ")";
if
(
current_state
==
WP_GETLIST
)
{
if
(
current_state
==
WP_GETLIST
)
{
sendWaypointRequestList
();
sendWaypointRequestList
();
}
else
if
(
current_state
==
WP_GETLIST_GETWPS
)
{
}
else
if
(
current_state
==
WP_GETLIST_GETWPS
)
{
...
@@ -74,7 +74,7 @@ void UASWaypointManager::timeout()
...
@@ -74,7 +74,7 @@ void UASWaypointManager::timeout()
}
else
{
}
else
{
protocol_timer
.
stop
();
protocol_timer
.
stop
();
qDebug
()
<<
"Waypoint transaction (state="
<<
current_state
<<
") timed out going to state WP_IDLE"
;
//
qDebug() << "Waypoint transaction (state=" << current_state << ") timed out going to state WP_IDLE";
emit
updateStatusString
(
"Operation timed out."
);
emit
updateStatusString
(
"Operation timed out."
);
...
@@ -92,7 +92,7 @@ void UASWaypointManager::handleWaypointCount(quint8 systemId, quint8 compId, qui
...
@@ -92,7 +92,7 @@ void UASWaypointManager::handleWaypointCount(quint8 systemId, quint8 compId, qui
protocol_timer
.
start
(
PROTOCOL_TIMEOUT_MS
);
protocol_timer
.
start
(
PROTOCOL_TIMEOUT_MS
);
current_retries
=
PROTOCOL_MAX_RETRIES
;
current_retries
=
PROTOCOL_MAX_RETRIES
;
qDebug
()
<<
"got waypoint count ("
<<
count
<<
") from ID "
<<
systemId
;
//
qDebug() << "got waypoint count (" << count << ") from ID " << systemId;
if
(
count
>
0
)
{
if
(
count
>
0
)
{
current_count
=
count
;
current_count
=
count
;
...
@@ -103,7 +103,7 @@ void UASWaypointManager::handleWaypointCount(quint8 systemId, quint8 compId, qui
...
@@ -103,7 +103,7 @@ void UASWaypointManager::handleWaypointCount(quint8 systemId, quint8 compId, qui
}
else
{
}
else
{
protocol_timer
.
stop
();
protocol_timer
.
stop
();
emit
updateStatusString
(
"done."
);
emit
updateStatusString
(
"done."
);
qDebug
()
<<
"No waypoints on UAS "
<<
systemId
;
//
qDebug() << "No waypoints on UAS " << systemId;
current_state
=
WP_IDLE
;
current_state
=
WP_IDLE
;
current_count
=
0
;
current_count
=
0
;
current_wp_id
=
0
;
current_wp_id
=
0
;
...
@@ -122,7 +122,7 @@ void UASWaypointManager::handleWaypoint(quint8 systemId, quint8 compId, mavlink_
...
@@ -122,7 +122,7 @@ void UASWaypointManager::handleWaypoint(quint8 systemId, quint8 compId, mavlink_
current_retries
=
PROTOCOL_MAX_RETRIES
;
current_retries
=
PROTOCOL_MAX_RETRIES
;
if
(
wp
->
seq
==
current_wp_id
)
{
if
(
wp
->
seq
==
current_wp_id
)
{
//qDebug() << "Got WP: " << wp->seq << wp->x << wp->y << wp->z << wp->param4 << "auto:" << wp->autocontinue << "curr:" << wp->current << wp->param1 << wp->param2 << "Frame:"<< (MAV_FRAME) wp->frame << "Command:" << (MAV_CMD) wp->command;
//
//
qDebug() << "Got WP: " << wp->seq << wp->x << wp->y << wp->z << wp->param4 << "auto:" << wp->autocontinue << "curr:" << wp->current << wp->param1 << wp->param2 << "Frame:"<< (MAV_FRAME) wp->frame << "Command:" << (MAV_CMD) wp->command;
Waypoint
*
lwp
=
new
Waypoint
(
wp
->
seq
,
wp
->
x
,
wp
->
y
,
wp
->
z
,
wp
->
param1
,
wp
->
param2
,
wp
->
param3
,
wp
->
param4
,
wp
->
autocontinue
,
wp
->
current
,
(
MAV_FRAME
)
wp
->
frame
,
(
MAV_CMD
)
wp
->
command
);
Waypoint
*
lwp
=
new
Waypoint
(
wp
->
seq
,
wp
->
x
,
wp
->
y
,
wp
->
z
,
wp
->
param1
,
wp
->
param2
,
wp
->
param3
,
wp
->
param4
,
wp
->
autocontinue
,
wp
->
current
,
(
MAV_FRAME
)
wp
->
frame
,
(
MAV_CMD
)
wp
->
command
);
addWaypoint
(
lwp
,
false
);
addWaypoint
(
lwp
,
false
);
...
@@ -145,7 +145,7 @@ void UASWaypointManager::handleWaypoint(quint8 systemId, quint8 compId, mavlink_
...
@@ -145,7 +145,7 @@ void UASWaypointManager::handleWaypoint(quint8 systemId, quint8 compId, mavlink_
emit
readGlobalWPFromUAS
(
false
);
emit
readGlobalWPFromUAS
(
false
);
emit
updateStatusString
(
"done."
);
emit
updateStatusString
(
"done."
);
qDebug
()
<<
"got all waypoints from ID "
<<
systemId
;
//
qDebug() << "got all waypoints from ID " << systemId;
}
}
}
else
{
}
else
{
emit
updateStatusString
(
tr
(
"Waypoint ID mismatch, rejecting waypoint"
));
emit
updateStatusString
(
tr
(
"Waypoint ID mismatch, rejecting waypoint"
));
...
@@ -163,12 +163,12 @@ void UASWaypointManager::handleWaypointAck(quint8 systemId, quint8 compId, mavli
...
@@ -163,12 +163,12 @@ void UASWaypointManager::handleWaypointAck(quint8 systemId, quint8 compId, mavli
protocol_timer
.
stop
();
protocol_timer
.
stop
();
current_state
=
WP_IDLE
;
current_state
=
WP_IDLE
;
emit
updateStatusString
(
"done."
);
emit
updateStatusString
(
"done."
);
qDebug
()
<<
"sent all waypoints to ID "
<<
systemId
;
//
qDebug() << "sent all waypoints to ID " << systemId;
}
else
if
(
current_state
==
WP_CLEARLIST
)
{
}
else
if
(
current_state
==
WP_CLEARLIST
)
{
protocol_timer
.
stop
();
protocol_timer
.
stop
();
current_state
=
WP_IDLE
;
current_state
=
WP_IDLE
;
emit
updateStatusString
(
"done."
);
emit
updateStatusString
(
"done."
);
qDebug
()
<<
"cleared waypoint list of ID "
<<
systemId
;
//
qDebug() << "cleared waypoint list of ID " << systemId;
}
}
}
}
}
}
...
@@ -217,18 +217,18 @@ void UASWaypointManager::handleWaypointCurrent(quint8 systemId, quint8 compId, m
...
@@ -217,18 +217,18 @@ void UASWaypointManager::handleWaypointCurrent(quint8 systemId, quint8 compId, m
}
}
}
}
//qDebug() << "Updated waypoints list";
//
//
qDebug() << "Updated waypoints list";
}
}
emit
updateStatusString
(
QString
(
"New current waypoint %1"
).
arg
(
wpc
->
seq
));
emit
updateStatusString
(
QString
(
"New current waypoint %1"
).
arg
(
wpc
->
seq
));
//emit update to UI widgets
//emit update to UI widgets
emit
currentWaypointChanged
(
wpc
->
seq
);
emit
currentWaypointChanged
(
wpc
->
seq
);
//qDebug() << "new current waypoint" << wpc->seq;
//
//
qDebug() << "new current waypoint" << wpc->seq;
}
}
}
}
void
UASWaypointManager
::
notifyOfChange
(
Waypoint
*
wp
)
void
UASWaypointManager
::
notifyOfChange
(
Waypoint
*
wp
)
{
{
qDebug
()
<<
"WAYPOINT CHANGED: ID:"
<<
wp
->
getId
();
//
qDebug() << "WAYPOINT CHANGED: ID:" << wp->getId();
// If only one waypoint was changed, emit only WP signal
// If only one waypoint was changed, emit only WP signal
if
(
wp
!=
NULL
)
{
if
(
wp
!=
NULL
)
{
emit
waypointChanged
(
uas
.
getUASID
(),
wp
);
emit
waypointChanged
(
uas
.
getUASID
(),
wp
);
...
@@ -713,7 +713,7 @@ void UASWaypointManager::writeWaypoints()
...
@@ -713,7 +713,7 @@ void UASWaypointManager::writeWaypoints()
sendWaypointClearAll
();
sendWaypointClearAll
();
}
else
{
}
else
{
//we're in another transaction, ignore command
//we're in another transaction, ignore command
qDebug
()
<<
"UASWaypointManager::sendWaypoints() doing something else ignoring command"
;
//
qDebug() << "UASWaypointManager::sendWaypoints() doing something else ignoring command";
}
}
}
}
...
@@ -731,7 +731,7 @@ void UASWaypointManager::sendWaypointClearAll()
...
@@ -731,7 +731,7 @@ void UASWaypointManager::sendWaypointClearAll()
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint clear all to ID "
<<
wpca
.
target_system
;
//
qDebug() << "sent waypoint clear all to ID " << wpca.target_system;
}
}
void
UASWaypointManager
::
sendWaypointSetCurrent
(
quint16
seq
)
void
UASWaypointManager
::
sendWaypointSetCurrent
(
quint16
seq
)
...
@@ -749,7 +749,7 @@ void UASWaypointManager::sendWaypointSetCurrent(quint16 seq)
...
@@ -749,7 +749,7 @@ void UASWaypointManager::sendWaypointSetCurrent(quint16 seq)
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint set current ("
<<
wpsc
.
seq
<<
") to ID "
<<
wpsc
.
target_system
;
//
qDebug() << "sent waypoint set current (" << wpsc.seq << ") to ID " << wpsc.target_system;
}
}
void
UASWaypointManager
::
sendWaypointCount
()
void
UASWaypointManager
::
sendWaypointCount
()
...
@@ -761,14 +761,14 @@ void UASWaypointManager::sendWaypointCount()
...
@@ -761,14 +761,14 @@ void UASWaypointManager::sendWaypointCount()
wpc
.
target_component
=
MAV_COMP_ID_WAYPOINTPLANNER
;
wpc
.
target_component
=
MAV_COMP_ID_WAYPOINTPLANNER
;
wpc
.
count
=
current_count
;
wpc
.
count
=
current_count
;
qDebug
()
<<
"sent waypoint count ("
<<
wpc
.
count
<<
") to ID "
<<
wpc
.
target_system
;
//
qDebug() << "sent waypoint count (" << wpc.count << ") to ID " << wpc.target_system;
emit
updateStatusString
(
QString
(
"Starting to transmit waypoints..."
));
emit
updateStatusString
(
QString
(
"Starting to transmit waypoints..."
));
mavlink_msg_waypoint_count_encode
(
uas
.
mavlink
->
getSystemId
(),
uas
.
mavlink
->
getComponentId
(),
&
message
,
&
wpc
);
mavlink_msg_waypoint_count_encode
(
uas
.
mavlink
->
getSystemId
(),
uas
.
mavlink
->
getComponentId
(),
&
message
,
&
wpc
);
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint count ("
<<
wpc
.
count
<<
") to ID "
<<
wpc
.
target_system
;
//
qDebug() << "sent waypoint count (" << wpc.count << ") to ID " << wpc.target_system;
}
}
void
UASWaypointManager
::
sendWaypointRequestList
()
void
UASWaypointManager
::
sendWaypointRequestList
()
...
@@ -785,7 +785,7 @@ void UASWaypointManager::sendWaypointRequestList()
...
@@ -785,7 +785,7 @@ void UASWaypointManager::sendWaypointRequestList()
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint list request to ID "
<<
wprl
.
target_system
;
//
qDebug() << "sent waypoint list request to ID " << wprl.target_system;
}
}
...
@@ -805,13 +805,13 @@ void UASWaypointManager::sendWaypointRequest(quint16 seq)
...
@@ -805,13 +805,13 @@ void UASWaypointManager::sendWaypointRequest(quint16 seq)
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint request ("
<<
wpr
.
seq
<<
") to ID "
<<
wpr
.
target_system
;
//
qDebug() << "sent waypoint request (" << wpr.seq << ") to ID " << wpr.target_system;
}
}
void
UASWaypointManager
::
sendWaypoint
(
quint16
seq
)
void
UASWaypointManager
::
sendWaypoint
(
quint16
seq
)
{
{
mavlink_message_t
message
;
mavlink_message_t
message
;
qDebug
()
<<
" WP Buffer count: "
<<
waypoint_buffer
.
count
();
//
qDebug() <<" WP Buffer count: "<<waypoint_buffer.count();
if
(
seq
<
waypoint_buffer
.
count
())
{
if
(
seq
<
waypoint_buffer
.
count
())
{
...
@@ -824,7 +824,7 @@ void UASWaypointManager::sendWaypoint(quint16 seq)
...
@@ -824,7 +824,7 @@ void UASWaypointManager::sendWaypoint(quint16 seq)
emit
updateStatusString
(
QString
(
"Sending waypoint ID %1 of %2 total"
).
arg
(
wp
->
seq
).
arg
(
current_count
));
emit
updateStatusString
(
QString
(
"Sending waypoint ID %1 of %2 total"
).
arg
(
wp
->
seq
).
arg
(
current_count
));
qDebug
()
<<
"sent waypoint ("
<<
wp
->
seq
<<
") to ID "
<<
wp
->
target_system
<<
" WP Buffer count: "
<<
waypoint_buffer
.
count
();
//
qDebug() << "sent waypoint (" << wp->seq << ") to ID " << wp->target_system<<" WP Buffer count: "<<waypoint_buffer.count();
mavlink_msg_waypoint_encode
(
uas
.
mavlink
->
getSystemId
(),
uas
.
mavlink
->
getComponentId
(),
&
message
,
wp
);
mavlink_msg_waypoint_encode
(
uas
.
mavlink
->
getSystemId
(),
uas
.
mavlink
->
getComponentId
(),
&
message
,
wp
);
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
...
@@ -846,5 +846,5 @@ void UASWaypointManager::sendWaypointAck(quint8 type)
...
@@ -846,5 +846,5 @@ void UASWaypointManager::sendWaypointAck(quint8 type)
uas
.
sendMessage
(
message
);
uas
.
sendMessage
(
message
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
MG
::
SLEEP
::
usleep
(
PROTOCOL_DELAY_MS
*
1000
);
qDebug
()
<<
"sent waypoint ack ("
<<
wpa
.
type
<<
") to ID "
<<
wpa
.
target_system
;
//
qDebug() << "sent waypoint ack (" << wpa.type << ") to ID " << wpa.target_system;
}
}
src/ui/HUD.cc
View file @
95533db6
...
@@ -198,7 +198,7 @@ void HUD::showEvent(QShowEvent* event)
...
@@ -198,7 +198,7 @@ void HUD::showEvent(QShowEvent* event)
{
{
// React only to internal (pre-display)
// React only to internal (pre-display)
// events
// events
Q
_UNUSED
(
event
)
Q
GLWidget
::
showEvent
(
event
);
refreshTimer
->
start
(
updateInterval
);
refreshTimer
->
start
(
updateInterval
);
}
}
...
@@ -206,7 +206,7 @@ void HUD::hideEvent(QHideEvent* event)
...
@@ -206,7 +206,7 @@ void HUD::hideEvent(QHideEvent* event)
{
{
// React only to internal (pre-display)
// React only to internal (pre-display)
// events
// events
Q
_UNUSED
(
event
);
Q
GLWidget
::
hideEvent
(
event
);
refreshTimer
->
stop
();
refreshTimer
->
stop
();
}
}
...
...
src/ui/WaypointView.cc
View file @
95533db6
...
@@ -504,7 +504,7 @@ void WaypointView::updateValues()
...
@@ -504,7 +504,7 @@ void WaypointView::updateValues()
if
(
customCommand
->
commandSpinBox
->
value
()
!=
wp
->
getAction
())
{
if
(
customCommand
->
commandSpinBox
->
value
()
!=
wp
->
getAction
())
{
customCommand
->
commandSpinBox
->
setValue
(
wp
->
getAction
());
customCommand
->
commandSpinBox
->
setValue
(
wp
->
getAction
());
qDebug
()
<<
"Changed action"
;
//
qDebug() << "Changed action";
}
}
// Param 1
// Param 1
if
(
customCommand
->
param1SpinBox
->
value
()
!=
wp
->
getParam1
())
{
if
(
customCommand
->
param1SpinBox
->
value
()
!=
wp
->
getParam1
())
{
...
@@ -545,7 +545,7 @@ void WaypointView::updateValues()
...
@@ -545,7 +545,7 @@ void WaypointView::updateValues()
if
(
currId
!=
lastId
)
if
(
currId
!=
lastId
)
{
{
qDebug
()
<<
"COLOR ID: "
<<
currId
;
//
qDebug() << "COLOR ID: " << currId;
if
(
currId
==
1
)
if
(
currId
==
1
)
{
{
//backGroundColor = backGroundColor.lighter(150);
//backGroundColor = backGroundColor.lighter(150);
...
@@ -555,7 +555,7 @@ void WaypointView::updateValues()
...
@@ -555,7 +555,7 @@ void WaypointView::updateValues()
{
{
backGroundColor
=
QColor
(
"#252528"
).
lighter
(
250
);
backGroundColor
=
QColor
(
"#252528"
).
lighter
(
250
);
}
}
qDebug
()
<<
"COLOR:"
<<
backGroundColor
.
name
();
//
qDebug() << "COLOR:" << backGroundColor.name();
// Update color based on id
// Update color based on id
QString
groupBoxStyle
=
QString
(
"QGroupBox {padding: 0px; margin: 0px; border: 0px; background-color: %1; }"
).
arg
(
backGroundColor
.
name
());
QString
groupBoxStyle
=
QString
(
"QGroupBox {padding: 0px; margin: 0px; border: 0px; background-color: %1; }"
).
arg
(
backGroundColor
.
name
());
...
...
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