Skip to content
GitLab
Projects
Groups
Snippets
/
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in
Toggle navigation
Menu
Open sidebar
Valentin Platzgummer
qgroundcontrol
Commits
a01e805a
Commit
a01e805a
authored
Dec 27, 2015
by
Don Gagne
Browse files
Update radio triggers
parent
7558a754
Changes
4
Hide whitespace changes
Inline
Side-by-side
src/AutoPilotPlugins/APM/APMRadioComponent.cc
View file @
a01e805a
...
...
@@ -29,6 +29,14 @@ APMRadioComponent::APMRadioComponent(Vehicle* vehicle, AutoPilotPlugin* autopilo
APMComponent
(
vehicle
,
autopilot
,
parent
),
_name
(
tr
(
"Radio"
))
{
_mapParams
<<
QStringLiteral
(
"RCMAP_ROLL"
)
<<
QStringLiteral
(
"RCMAP_PITCH"
)
<<
QStringLiteral
(
"RCMAP_YAW"
)
<<
QStringLiteral
(
"RCMAP_THROTTLE"
);
foreach
(
const
QString
&
mapParam
,
_mapParams
)
{
Fact
*
fact
=
_autopilot
->
getParameterFact
(
-
1
,
mapParam
);
connect
(
fact
,
&
Fact
::
valueChanged
,
this
,
&
APMRadioComponent
::
_triggerChanged
);
}
_connectSetupTriggers
();
}
QString
APMRadioComponent
::
name
(
void
)
const
...
...
@@ -56,25 +64,38 @@ bool APMRadioComponent::requiresSetup(void) const
bool
APMRadioComponent
::
setupComplete
(
void
)
const
{
// The best we can do to detect the need for a radio calibration is look for attitude
// controls to be mapped.
QStringList
attitudeMappings
;
attitudeMappings
<<
"RCMAP_ROLL"
<<
"RCMAP_PITCH"
<<
"RCMAP_YAW"
<<
"RCMAP_THROTTLE"
;
foreach
(
const
QString
&
mapParam
,
attitudeMappings
)
{
if
(
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
mapParam
)
->
rawValue
().
toInt
()
==
0
)
{
// controls to be mapped as well as all attitude control rc min/max/trim still at defaults.
QList
<
int
>
mapValues
;
// First check for all attitude controls mapped
for
(
int
i
=
0
;
i
<
_mapParams
.
count
();
i
++
)
{
mapValues
<<
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
_mapParams
[
i
])
->
rawValue
().
toInt
();
if
(
mapValues
[
i
]
<=
0
)
{
return
false
;
}
}
// Next check RC#_MIN/MAX/TRIM all at defaults
foreach
(
const
QString
&
mapParam
,
_mapParams
)
{
int
channel
=
_autopilot
->
getParameterFact
(
-
1
,
mapParam
)
->
rawValue
().
toInt
();
if
(
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_MIN"
).
arg
(
channel
))
->
rawValue
().
toInt
()
!=
1100
)
{
return
true
;
}
if
(
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_MAX"
).
arg
(
channel
))
->
rawValue
().
toInt
()
!=
1900
)
{
return
true
;
}
if
(
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_TRIM"
).
arg
(
channel
))
->
rawValue
().
toInt
()
!=
1500
)
{
return
true
;
}
}
return
tru
e
;
return
fals
e
;
}
QStringList
APMRadioComponent
::
setupCompleteChangedTriggerList
(
void
)
const
{
QStringList
triggers
;
triggers
<<
"RCMAP_ROLL"
<<
"RCMAP_PITCH"
<<
"RCMAP_YAW"
<<
"RCMAP_THROTTLE"
;
return
triggers
;
// APMRadioComponent manages it's own triggers
return
QStringList
();
}
QUrl
APMRadioComponent
::
setupSource
(
void
)
const
...
...
@@ -93,8 +114,41 @@ QString APMRadioComponent::prerequisiteSetup(void) const
if
(
!
plugin
->
airframeComponent
()
->
setupComplete
())
{
return
plugin
->
airframeComponent
()
->
name
();
}
return
QString
();
}
void
APMRadioComponent
::
_connectSetupTriggers
(
void
)
{
// Disconnect previous triggers
foreach
(
Fact
*
fact
,
_triggerFacts
)
{
disconnect
(
fact
,
&
Fact
::
valueChanged
,
this
,
&
APMRadioComponent
::
_triggerChanged
);
}
_triggerFacts
.
clear
();
// Get the channels for attitude controls and connect to those values for triggers
foreach
(
const
QString
&
mapParam
,
_mapParams
)
{
int
channel
=
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
mapParam
)
->
rawValue
().
toInt
();
Fact
*
fact
=
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_MIN"
).
arg
(
channel
));
_triggerFacts
<<
fact
;
connect
(
fact
,
&
Fact
::
valueChanged
,
this
,
&
APMRadioComponent
::
_triggerChanged
);
fact
=
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_MAX"
).
arg
(
channel
));
_triggerFacts
<<
fact
;
connect
(
fact
,
&
Fact
::
valueChanged
,
this
,
&
APMRadioComponent
::
_triggerChanged
);
fact
=
_autopilot
->
getParameterFact
(
-
1
,
QString
(
"RC%1_TRIM"
).
arg
(
channel
));
_triggerFacts
<<
fact
;
connect
(
fact
,
&
Fact
::
valueChanged
,
this
,
&
APMRadioComponent
::
_triggerChanged
);
}
}
void
APMRadioComponent
::
_triggerChanged
(
void
)
{
emit
setupCompleteChanged
(
setupComplete
());
// Control mapping may have changed so we need to reset triggers
_connectSetupTriggers
();
}
src/AutoPilotPlugins/APM/APMRadioComponent.h
View file @
a01e805a
...
...
@@ -25,6 +25,7 @@
#define APMRadioComponent_H
#include
"APMComponent.h"
#include
"Fact.h"
class
APMRadioComponent
:
public
APMComponent
{
...
...
@@ -45,10 +46,16 @@ public:
virtual
QUrl
setupSource
(
void
)
const
;
virtual
QUrl
summaryQmlSource
(
void
)
const
;
virtual
QString
prerequisiteSetup
(
void
)
const
;
private
slots
:
void
_triggerChanged
(
void
);
private:
void
_connectSetupTriggers
(
void
);
const
QString
_name
;
QVariantList
_summaryItems
;
QStringList
_mapParams
;
QList
<
Fact
*>
_triggerFacts
;
};
#endif
src/comm/APMArduCopterMockLink.params
View file @
a01e805a
...
...
@@ -331,7 +331,7 @@
1 1 RC14_TRIM 1500 4
1 1 RC1_DZ 30 4
1 1 RC1_MAX 1900 4
1 1 RC1_MIN 110
0
4
1 1 RC1_MIN 110
1
4
1 1 RC1_REV 1 2
1 1 RC1_TRIM 1500 4
1 1 RC2_DZ 30 4
...
...
src/comm/APMArduPlaneMockLink.params
View file @
a01e805a
...
...
@@ -366,7 +366,7 @@
1 1 RC14_TRIM 1500 4
1 1 RC1_DZ 30 4
1 1 RC1_MAX 1900 4
1 1 RC1_MIN 110
0
4
1 1 RC1_MIN 110
1
4
1 1 RC1_REV 1 2
1 1 RC1_TRIM 1500 4
1 1 RC2_DZ 30 4
...
...
Write
Preview
Supports
Markdown
0%
Try again
or
attach a new 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