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
698a3e35
Commit
698a3e35
authored
Dec 03, 2015
by
Don Gagne
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
Move acceptance radius to friendly edit
Both altitude and acceptance radius will track last value
parent
1adde9d5
Changes
5
Hide whitespace changes
Inline
Side-by-side
Showing
5 changed files
with
51 additions
and
17 deletions
+51
-17
MavCmdInfo.json
src/MissionManager/MavCmdInfo.json
+6
-0
MissionController.cc
src/MissionManager/MissionController.cc
+39
-5
MissionController.h
src/MissionManager/MissionController.h
+2
-1
MissionItem.cc
src/MissionManager/MissionItem.cc
+4
-6
MissionItem.h
src/MissionManager/MissionItem.h
+0
-5
No files found.
src/MissionManager/MavCmdInfo.json
View file @
698a3e35
...
...
@@ -25,6 +25,12 @@
"units"
:
"seconds"
,
"default"
:
0
,
"decimalPlaces"
:
0
},
"param2"
:
{
"label"
:
"Accept radius:"
,
"units"
:
"meters"
,
"default"
:
3.0
,
"decimalPlaces"
:
2
}
},
{
...
...
src/MissionManager/MissionController.cc
View file @
698a3e35
...
...
@@ -169,7 +169,14 @@ int MissionController::addMissionItem(QGeoCoordinate coordinate)
}
newItem
->
setDefaultsForCommand
();
if
((
MAV_CMD
)
newItem
->
command
()
==
MAV_CMD_NAV_WAYPOINT
)
{
newItem
->
setParam7
(
_findLastAltitude
());
double
lastValue
;
if
(
_findLastAcceptanceRadius
(
&
lastValue
))
{
newItem
->
setParam2
(
lastValue
);
}
if
(
_findLastAltitude
(
&
lastValue
))
{
newItem
->
setParam7
(
lastValue
);
}
}
_missionItems
->
append
(
newItem
);
...
...
@@ -611,17 +618,44 @@ QmlObjectListModel* MissionController::missionItems(void)
return
_missionItems
;
}
double
MissionController
::
_findLastAltitude
(
void
)
bool
MissionController
::
_findLastAltitude
(
double
*
lastAltitude
)
{
double
lastAltitude
=
MissionItem
::
defaultAltitude
;
bool
found
=
false
;
double
foundAltitude
;
for
(
int
i
=
0
;
i
<
_missionItems
->
count
();
i
++
)
{
MissionItem
*
item
=
qobject_cast
<
MissionItem
*>
(
_missionItems
->
get
(
i
));
if
(
item
->
specifiesCoordinate
())
{
lastAltitude
=
item
->
param7
();
foundAltitude
=
item
->
param7
();
found
=
true
;
}
}
return
lastAltitude
;
if
(
found
)
{
*
lastAltitude
=
foundAltitude
;
}
return
found
;
}
bool
MissionController
::
_findLastAcceptanceRadius
(
double
*
lastAcceptanceRadius
)
{
bool
found
=
false
;
double
foundAcceptanceRadius
;
for
(
int
i
=
0
;
i
<
_missionItems
->
count
();
i
++
)
{
MissionItem
*
item
=
qobject_cast
<
MissionItem
*>
(
_missionItems
->
get
(
i
));
if
((
MAV_CMD
)
item
->
command
()
==
MAV_CMD_NAV_WAYPOINT
)
{
foundAcceptanceRadius
=
item
->
param2
();
found
=
true
;
}
}
if
(
found
)
{
*
lastAcceptanceRadius
=
foundAcceptanceRadius
;
}
return
found
;
}
src/MissionManager/MissionController.h
View file @
698a3e35
...
...
@@ -95,7 +95,8 @@ private:
void
_setupMissionItems
(
bool
loadFromVehicle
,
bool
forceLoad
);
void
_setupActiveVehicle
(
Vehicle
*
activeVehicle
,
bool
forceLoadFromVehicle
);
void
_calcPrevWaypointValues
(
bool
homePositionValid
,
double
homeAlt
,
MissionItem
*
item1
,
MissionItem
*
item2
,
double
*
azimuth
,
double
*
distance
);
double
_findLastAltitude
(
void
);
bool
_findLastAltitude
(
double
*
lastAltitude
);
bool
_findLastAcceptanceRadius
(
double
*
lastAcceptanceRadius
);
private:
bool
_editMode
;
...
...
src/MissionManager/MissionItem.cc
View file @
698a3e35
...
...
@@ -29,12 +29,7 @@ This file is part of the QGROUNDCONTROL project
QGC_LOGGING_CATEGORY
(
MissionItemLog
,
"MissionItemLog"
)
const
double
MissionItem
::
defaultTakeoffPitch
=
15.0
;
const
double
MissionItem
::
defaultHeading
=
0.0
;
const
double
MissionItem
::
defaultAltitude
=
25.0
;
const
double
MissionItem
::
defaultAcceptanceRadius
=
3.0
;
const
double
MissionItem
::
defaultLoiterOrbitRadius
=
10.0
;
const
double
MissionItem
::
defaultLoiterTurns
=
1.0
;
FactMetaData
*
MissionItem
::
_altitudeMetaData
=
NULL
;
FactMetaData
*
MissionItem
::
_commandMetaData
=
NULL
;
...
...
@@ -122,6 +117,7 @@ MissionItem::MissionItem(QObject* parent)
_connectSignals
();
setAutoContinue
(
true
);
setDefaultsForCommand
();
}
MissionItem
::
MissionItem
(
int
sequenceNumber
,
...
...
@@ -770,13 +766,15 @@ void MissionItem::_syncCommandToSupportedCommand(const QVariant& value)
void
MissionItem
::
setDefaultsForCommand
(
void
)
{
// We set these global defaults first, then if there are param defaults they will get reset
setParam7
(
defaultAltitude
);
foreach
(
const
MavCmdParamInfo
*
paramInfo
,
_mavCmdInfoMap
[(
MAV_CMD
)
command
()]
->
paramInfoMap
())
{
Fact
*
rgParamFacts
[
7
]
=
{
&
_param1Fact
,
&
_param2Fact
,
&
_param3Fact
,
&
_param4Fact
,
&
_param5Fact
,
&
_param6Fact
,
&
_param7Fact
};
rgParamFacts
[
paramInfo
->
param
()
-
1
]
->
setRawValue
(
paramInfo
->
defaultValue
());
}
setParam7
(
defaultAltitude
);
setAutoContinue
(
true
);
setFrame
(
specifiesCoordinate
()
?
MAV_FRAME_GLOBAL_RELATIVE_ALT
:
MAV_FRAME_MISSION
);
setRawEdit
(
false
);
...
...
src/MissionManager/MissionItem.h
View file @
698a3e35
...
...
@@ -167,12 +167,7 @@ public:
bool
relativeAltitude
(
void
)
{
return
frame
()
==
MAV_FRAME_GLOBAL_RELATIVE_ALT
;
}
static
const
double
defaultTakeoffPitch
;
static
const
double
defaultHeading
;
static
const
double
defaultAltitude
;
static
const
double
defaultAcceptanceRadius
;
static
const
double
defaultLoiterOrbitRadius
;
static
const
double
defaultLoiterTurns
;
public
slots
:
void
setDefaultsForCommand
(
void
);
...
...
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