MAVLinkStats.java

Go to the documentation of this file.

/* AUTO-GENERATED FILE.  DO NOT MODIFY.
 *
 * This class was automatically generated by the
 * java mavlink generator tool. It should not be modified by hand.
 */

package com.MAVLink.Messages;

import com.MAVLink.MAVLinkPacket;

public class MAVLinkStats /* implements Serializable */{

    public int receivedPacketCount;

    public int crcErrorCount;

    public int lostPacketCount;

    private int lastPacketSeq;

    public void newPacket(MAVLinkPacket packet) {
        advanceLastPacketSequence();
        if (hasLostPackets(packet)) {
            updateLostPacketCount(packet);
        }
        lastPacketSeq = packet.seq;
        receivedPacketCount++;
    }

    private void updateLostPacketCount(MAVLinkPacket packet) {
        int lostPackets;
        if (packet.seq - lastPacketSeq < 0) {
            lostPackets = (packet.seq - lastPacketSeq) + 255;
        } else {
            lostPackets = (packet.seq - lastPacketSeq);
        }
        lostPacketCount += lostPackets;
    }

    private boolean hasLostPackets(MAVLinkPacket packet) {
        return lastPacketSeq > 0 && packet.seq != lastPacketSeq;
    }

    private void advanceLastPacketSequence() {
        // wrap from 255 to 0 if necessary
        lastPacketSeq = (lastPacketSeq + 1) & 0xFF;
    }

    public void crcError() {
        crcErrorCount++;
    }

    public void mavlinkResetStats() {
        lastPacketSeq = -1;
        lostPacketCount = 0;
        crcErrorCount = 0;
        receivedPacketCount = 0;
    }

}