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
ba486be4
Commit
ba486be4
authored
Jun 25, 2016
by
Don Gagne
Committed by
GitHub
Jun 25, 2016
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
Solo param usage fixes (#3663)
* Deal with missing parameters on Solo * Fix trigger set
parent
f5ae0a2e
Changes
5
Show whitespace changes
Inline
Side-by-side
Showing
5 changed files
with
96 additions
and
60 deletions
+96
-60
APMSensorsComponent.cc
src/AutoPilotPlugins/APM/APMSensorsComponent.cc
+33
-14
ParameterLoader.cc
src/FactSystem/ParameterLoader.cc
+1
-1
APMFirmwarePlugin.cc
src/FirmwarePlugin/APM/APMFirmwarePlugin.cc
+1
-0
Vehicle.cc
src/Vehicle/Vehicle.cc
+10
-0
Vehicle.h
src/Vehicle/Vehicle.h
+51
-45
No files found.
src/AutoPilotPlugins/APM/APMSensorsComponent.cc
View file @
ba486be4
...
...
@@ -62,6 +62,12 @@ QStringList APMSensorsComponent::setupCompleteChangedTriggerList(void) const
// Accelerometer triggers
triggers
<<
"INS_ACCOFFS_X"
<<
"INS_ACCOFFS_Y"
<<
"INS_ACCOFFS_Z"
;
if
(
_autopilot
->
parameterExists
(
FactSystem
::
defaultComponentId
,
QStringLiteral
(
"INS_USE"
)))
{
triggers
<<
QStringLiteral
(
"INS_USE"
)
<<
QStringLiteral
(
"INS_USE2"
)
<<
QStringLiteral
(
"INS_USE3"
);
triggers
<<
QStringLiteral
(
"INS_ACC2OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Z"
);
triggers
<<
QStringLiteral
(
"INS_ACC3OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Z"
);
}
return
triggers
;
}
...
...
@@ -117,20 +123,33 @@ bool APMSensorsComponent::compassSetupNeeded(void) const
bool
APMSensorsComponent
::
accelSetupNeeded
(
void
)
const
{
const
size_t
cAccel
=
3
;
const
size_t
cOffset
=
3
;
QStringList
rgUse
;
QStringList
rgOffsets
[
cAccel
];
QStringList
rgOffsets
;
QList
<
QStringList
>
rgAccels
;
// We always at a minimum test the first accel
rgOffsets
<<
QStringLiteral
(
"INS_ACCOFFS_X"
)
<<
QStringLiteral
(
"INS_ACCOFFS_Y"
)
<<
QStringLiteral
(
"INS_ACCOFFS_Z"
);
rgAccels
<<
rgOffsets
;
rgOffsets
.
clear
();
// This parameter is not available in all firmware version. Specifically missing from older Solo firmware.
if
(
_autopilot
->
parameterExists
(
FactSystem
::
defaultComponentId
,
QStringLiteral
(
"INS_USE"
)))
{
rgUse
<<
QStringLiteral
(
"INS_USE"
)
<<
QStringLiteral
(
"INS_USE2"
)
<<
QStringLiteral
(
"INS_USE3"
);
rgOffsets
[
0
]
<<
QStringLiteral
(
"INS_ACCOFFS_X"
)
<<
QStringLiteral
(
"INS_ACCOFFS_Y"
)
<<
QStringLiteral
(
"INS_ACCOFFS_Z"
);
rgOffsets
[
1
]
<<
QStringLiteral
(
"INS_ACC2OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Z"
);
rgOffsets
[
2
]
<<
QStringLiteral
(
"INS_ACC3OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Z"
);
for
(
size_t
i
=
0
;
i
<
cAccel
;
i
++
)
{
if
(
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
rgUse
[
i
])
->
rawValue
().
toInt
()
!=
0
)
{
for
(
size_t
j
=
0
;
j
<
cOffset
;
j
++
)
{
if
(
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
rgOffsets
[
i
][
j
])
->
rawValue
().
toFloat
()
==
0.0
f
)
{
// We have usage information for the remaining accels, so we can test them sa well
rgOffsets
<<
QStringLiteral
(
"INS_ACC2OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC2OFFS_Z"
);
rgAccels
<<
rgOffsets
;
rgOffsets
.
clear
();
rgOffsets
<<
QStringLiteral
(
"INS_ACC3OFFS_X"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Y"
)
<<
QStringLiteral
(
"INS_ACC3OFFS_Z"
);
rgAccels
<<
rgOffsets
;
rgOffsets
.
clear
();
}
for
(
int
i
=
0
;
i
<
rgAccels
.
count
();
i
++
)
{
if
(
rgUse
.
count
()
==
0
||
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
rgUse
[
i
])
->
rawValue
().
toInt
()
!=
0
)
{
for
(
int
j
=
0
;
j
<
rgAccels
[
0
].
count
();
j
++
)
{
if
(
_autopilot
->
getParameterFact
(
FactSystem
::
defaultComponentId
,
rgAccels
[
i
][
j
])
->
rawValue
().
toFloat
()
==
0.0
f
)
{
return
true
;
}
}
...
...
src/FactSystem/ParameterLoader.cc
View file @
ba486be4
...
...
@@ -1196,7 +1196,7 @@ QString ParameterLoader::_remapParamNameToVersion(const QString& paramName)
const
FirmwarePlugin
::
remapParamNameMinorVersionRemapMap_t
&
remapMinorVersion
=
majorVersionRemap
[
majorVersion
];
// We must map from the highest known minor version to one above the vehicle's minor version
// We must map
backwards
from the highest known minor version to one above the vehicle's minor version
for
(
int
currentMinorVersion
=
_vehicle
->
firmwarePlugin
()
->
remapParamNameHigestMinorVersionNumber
(
majorVersion
);
currentMinorVersion
>
minorVersion
;
currentMinorVersion
--
)
{
if
(
remapMinorVersion
.
contains
(
currentMinorVersion
))
{
...
...
src/FirmwarePlugin/APM/APMFirmwarePlugin.cc
View file @
ba486be4
...
...
@@ -373,6 +373,7 @@ bool APMFirmwarePlugin::_handleStatusText(Vehicle* vehicle, mavlink_message_t* m
if
(
messageText
.
contains
(
APM_SOLO_REXP
))
{
qDebug
()
<<
"Found Solo"
;
vehicle
->
setSoloFirmware
(
true
);
// Fix up severity
_setInfoSeverity
(
message
);
...
...
src/Vehicle/Vehicle.cc
View file @
ba486be4
...
...
@@ -67,6 +67,8 @@ Vehicle::Vehicle(LinkInterface* link,
,
_vehicleType
(
vehicleType
)
,
_firmwarePlugin
(
NULL
)
,
_autopilotPlugin
(
NULL
)
,
_mavlink
(
NULL
)
,
_soloFirmware
(
false
)
,
_joystickMode
(
JoystickModeRC
)
,
_joystickEnabled
(
false
)
,
_uas
(
NULL
)
...
...
@@ -1697,6 +1699,14 @@ int Vehicle::defaultComponentId(void)
return
_parameterLoader
->
defaultComponenentId
();
}
void
Vehicle
::
setSoloFirmware
(
bool
soloFirmware
)
{
if
(
soloFirmware
!=
_soloFirmware
)
{
_soloFirmware
=
soloFirmware
;
emit
soloFirmwareChanged
(
soloFirmware
);
}
}
const
char
*
VehicleGPSFactGroup
::
_hdopFactName
=
"hdop"
;
const
char
*
VehicleGPSFactGroup
::
_vdopFactName
=
"vdop"
;
const
char
*
VehicleGPSFactGroup
::
_courseOverGroundFactName
=
"courseOverGround"
;
...
...
src/Vehicle/Vehicle.h
View file @
ba486be4
...
...
@@ -264,6 +264,7 @@ public:
Q_PROPERTY
(
int
rcRSSI
READ
rcRSSI
NOTIFY
rcRSSIChanged
)
Q_PROPERTY
(
bool
px4Firmware
READ
px4Firmware
CONSTANT
)
Q_PROPERTY
(
bool
apmFirmware
READ
apmFirmware
CONSTANT
)
Q_PROPERTY
(
bool
soloFirmware
READ
soloFirmware
WRITE
setSoloFirmware
NOTIFY
soloFirmwareChanged
)
Q_PROPERTY
(
bool
genericFirmware
READ
genericFirmware
CONSTANT
)
Q_PROPERTY
(
bool
connectionLost
READ
connectionLost
NOTIFY
connectionLostChanged
)
Q_PROPERTY
(
bool
connectionLostEnabled
READ
connectionLostEnabled
WRITE
setConnectionLostEnabled
NOTIFY
connectionLostEnabledChanged
)
...
...
@@ -529,6 +530,9 @@ public:
void
setFirmwareVersion
(
int
majorVersion
,
int
minorVersion
,
int
patchVersion
,
FIRMWARE_VERSION_TYPE
versionType
=
FIRMWARE_VERSION_TYPE_OFFICIAL
);
static
const
int
versionNotSetValue
=
-
1
;
bool
soloFirmware
(
void
)
const
{
return
_soloFirmware
;
}
void
setSoloFirmware
(
bool
soloFirmware
);
int
defaultComponentId
(
void
);
public
slots
:
...
...
@@ -556,6 +560,7 @@ signals:
void
guidedModeChanged
(
bool
guidedMode
);
void
prearmErrorChanged
(
const
QString
&
prearmError
);
void
commandLongAck
(
uint8_t
compID
,
uint16_t
command
,
uint8_t
result
);
void
soloFirmwareChanged
(
bool
soloFirmware
);
void
messagesReceivedChanged
();
void
messagesSentChanged
();
...
...
@@ -656,6 +661,7 @@ private:
FirmwarePlugin
*
_firmwarePlugin
;
AutoPilotPlugin
*
_autopilotPlugin
;
MAVLinkProtocol
*
_mavlink
;
bool
_soloFirmware
;
QList
<
LinkInterface
*>
_links
;
...
...
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