Softivation

Pixhawk PreArm mesajı yarım geliyor (C# yer istasyonu)

C# yer istasyonunda Pixhawk PreArm mesajı yarım geliyor, altında tek bir harf kalıyorsa STATUSTEXT bölünmüştür. Parçaları id ile birleştiren kodu gör.

Furkan IŞIKAY 5 dk okuma

PreArm satırı yer istasyonunda ikiye bölünüyor

C# ile yazdığın yer kontrol istasyonu Pixhawk'a bağlı, telemetri akıyor. Mesaj panelinde ise PreArm satırı "critical >= lo" diye bitiyor ve hemen altında tek başına bir "w" duruyor.

Bazen panel bağlandıktan sonra yarım dakika boş kalıyor, bazen hiç dolmuyor. ARM düğmesine basınca drone ARM olmuyor ve sebebini okuyamıyorsun.

Üç ayrı sebep var, üçü de STATUSTEXT mesajının gönderiliş biçiminden çıkıyor: otopilot 50 karakteri aşan metni parçalıyor, tam 50 karakterlik metnin sonuna bitiş karakteri koymuyor ve bu satırları yalnız kendisiyle konuşan bağlantıya yolluyor.

Metin neden iki pakete bölünüyor

STATUSTEXT'in metin alanı 50 bayttır. ArduPilot daha uzun bir satır yollayacaksa onu 50'şer karakterlik parçalara böler, her parçaya aynı id numarasını ve 0'dan başlayan bir sıra numarası koyar.

Şekilde ilk paketin metin kutusu sarı işaretli "o" harfinde doluyor, "w" ikinci pakete kalıyor. İki paketi birbirine bağlayan tek alan id = 1. Her STATUSTEXT paketini ayrı satır basan kod bu yüzden ekranda iki satır gösterir.

Tek PreArm satırı, iki STATUSTEXT paketi

STATUSTEXT 51 karakterlik metni iki pakete böler: ilk parça 50 karakterle biter ve sonunda null yoktur, ikinci parça tek harf ve sıra 1 taşır, aynı id ile birleşince tam metin çıkar
Nereye bak: ilk parçada text kutusu sarı “o” harfinde doluyor, “w” ikinci pakette; iki paketi id = 1 bağlıyor.

Tek paketlik metinlerde id 0 gelir. Metin tam 50 karakterse alanın sonunda \0 olmaz; ilk sıfır baytını arayan kod -1 bulur ve uzunluğu yanlış hesaplar.

MAVLink 2 ayrıca payload'un sonundaki sıfır baytları atar; kısa bir STATUSTEXT 54 yerine 22 baytla gelebilir. Metni her pakette 50 bayt okuyan kod bu pakette istisna fırlatır.

Batarya ayarında nasıl karşına çıkar

Batarya failsafe'ini kurarken BATT_CRT_VOLT'u 10.5 yaptın. Copter'da BATT_LOW_VOLT'un varsayılanı da 10.5. Kritik eşik düşük eşikten küçük olmadığı için otopilot ARM izni vermez ve PreArm: Battery 1 voltage failsafe critical >= low satırını yollar.

Bu satır tam 50 karakterdir, sonunda \0 yoktur. Aynı hatayı mAh tarafında yaparsan (BATT_CRT_MAH'ı BATT_LOW_MAH'a eşit ya da ondan büyük girersen) metin 51 karakter olur ve iki pakete bölünür: panelde "lo" ilk paketin sonu, "w" ikinci paketin tamamıdır.

Panel neden ilk yarım dakika boş kalıyor

Otopilot başarısız ön kontrolleri, drone ARM'lı değilken 30 saniyede bir yollar. Bağlantıyı iki gönderimin arasında açtıysan ilk PreArm satırını görmek 30 saniyeyi bulabilir. ARM komutu yollarsan sebep beklemeden, "Arm:" ile başlayan bir satırla gelir.

Yer istasyonun otopilota hiç paket yollamıyorsa beklemenin sonu gelmez. ArduPilot STATUSTEXT'i yalnız kendisine en az bir MAVLink paketi gelmiş ya da akış hızı açık bağlantılara gönderir; Copter'da MAVn_ akış hızlarının varsayılanı 0'dır. Saniyede bir HEARTBEAT yollamak bağlantıyı açar.

Metni doğru birleştiren C# kodu

Aşağıdaki sınıf, çerçeveyi çözen kodunun verdiği STATUSTEXT payload'unu alır. Eksik baytları sıfırla tamamlar, metni ilk \0'a kadar ya da 50 karakterin tamamıyla okur ve parçalı metni id'ye göre birleştirir.

C#StatusText.cs
using System;
using System.Collections.Generic;
using System.Text;

// STATUSTEXT payload'undan tam satırı çıkarır; devamı bekleniyorsa null döner
public static class StatusText
{
    static readonly Dictionary<ushort, string> bekleyen = new Dictionary<ushort, string>();

    public static string? Coz(byte[] gelen)
    {
        byte[] p = new byte[54];                   // MAVLink 2 sondaki sıfırları kırpar
        Array.Copy(gelen, p, Math.Min(gelen.Length, 54));
        int nul = Array.IndexOf(p, (byte)0, 1, 50);
        int n = nul < 0 ? 50 : nul - 1;            // 50 karakter doluysa '\0' yok
        string parca = Encoding.ASCII.GetString(p, 1, n);
        ushort id = BitConverter.ToUInt16(p, 51);
        if (id == 0) return parca;                 // tek paketlik metin
        bekleyen[id] = bekleyen.GetValueOrDefault(id, "") + parca;
        if (n == 50) return null;                  // devamı gelecek
        string tam = bekleyen[id];
        bekleyen.Remove(id);
        return tam;
    }
}
  1. Gir: StatusText.cs'i projene ekle. 253 numaralı mesajın payload'unu StatusText.Coz'a ver, null dönmeyen değeri mesaj paneline yaz. Aynı bağlantıdan saniyede bir HEARTBEAT yolla.
  2. Gör: PreArm satırı tek parça hâlinde ve "low" ile bitiyor.
  3. Değilse: hiç satır gelmiyorsa HEARTBEAT'in gittiğini kontrol et; CRC_EXTRA değeri 50 değilse otopilot paketi hata vermeden atar. Satır hâlâ bölünüyorsa Coz'a yalnız 253 numaralı mesajı verdiğinden emin ol.

Ne göreceksin

BATT_LOW_MAH 500, BATT_CRT_MAH 800 iken (ikisinin varsayılanı 0) panelde tek satır görürsün:

Çıktı
PreArm: Battery 1 capacity failsafe critical >= low

BATT_LOW_VOLT ve BATT_CRT_VOLT ikisi de 10.5 iken aynı satır 30 saniyede bir tekrar eder:

Çıktı
PreArm: Battery 1 voltage failsafe critical >= low
PreArm: Battery 1 voltage failsafe critical >= low

Hata Mesajları

PreArm: Battery 1 capacity failsafe critical >= low

BATT_LOW_MAH, BATT_CRT_MAH'tan büyük değil. Düşük eşiği kritik eşiğin üstüne çek. Panelde "lo" ve "w" diye iki satır görüyorsan bu metin bölünmüş geliyordur.

PreArm: Battery 1 voltage failsafe critical >= low

BATT_LOW_VOLT, BATT_CRT_VOLT'tan büyük değil. Copter'da düşük eşik varsayılan olarak 10.5 V'tur; kritik eşiği bunun altına indir.

ArgumentOutOfRangeException: Index and count must refer to a location within the buffer. (Parameter 'bytes')

Encoding.ASCII.GetString(payload, 1, 50) kırpılmış payload'da 50 bayt bulamadı. Payload'u okumadan önce 54 bayta sıfırla tamamla.

ArgumentOutOfRangeException: Non-negative number required. (Parameter 'byteCount')

Array.IndexOf -1 döndü, metin alanı 50 karakterle doluydu. -1 gördüğünde uzunluğu 50 say.

Sıradaki adım

Parçalar karışık sırayla gelirse ya da biri telemetri hattında düşerse ne yapacağını, otopilotun bu satırları neden 30 saniyede bir yolladığını Sıfırdan İleri Seviyeye C# Eğitimi'nin Sorun giderme bölümünde kaynak koddan izlersin. Aynı bölümde ARM, parametre ve mod etiketi dersleri de var.

Bu yazı işinize yaradı mı?