修正很多问题
This commit is contained in:
@@ -950,6 +950,7 @@ void Payload::setup_commands(void)
|
||||
//发到encap
|
||||
|
||||
QByteArray rwr_encap;
|
||||
rwr_encap.clear();
|
||||
|
||||
for(int i = 0;i< 13;i++)
|
||||
{
|
||||
@@ -1127,6 +1128,7 @@ void Payload::setup_commands(void)
|
||||
//发送到encap
|
||||
|
||||
QByteArray uv_encap;
|
||||
uv_encap.clear();
|
||||
|
||||
for(int i = 0;i< 13;i++)
|
||||
{
|
||||
|
||||
@@ -280,16 +280,19 @@ void DataStream::sendAFrame(void)
|
||||
|
||||
size_t len = databuff.size();
|
||||
|
||||
if(len > 253)
|
||||
{
|
||||
len = 253;
|
||||
}
|
||||
|
||||
for(uint16_t i = 0;i < len;i++)
|
||||
{
|
||||
encapsulated_data.data[i] = (uint8_t)databuff[i];
|
||||
}
|
||||
|
||||
if(len < 253)
|
||||
{
|
||||
for(uint16_t i = len;i < 253;i++)
|
||||
{
|
||||
encapsulated_data.data[i] = 0;
|
||||
}
|
||||
}
|
||||
|
||||
qDebug() << "send encap" << databuff;
|
||||
|
||||
mavlink_msg_encapsulated_data_encode(GCS_SysID,GCS_CompID, &msg,&encapsulated_data);
|
||||
|
||||
Reference in New Issue
Block a user