00001
00002
00003
00004
00005
00006
00007
00008 #include <telekyb_defines/MKDefines.hpp>
00009
00010
00011
00012
00013 bool operator==(const MKActiveIDs& lhs, const MKActiveIDs& rhs)
00014 {
00015 for (int i = 0; i < ACTIVEDATA_SIZE; i++) {
00016 if (lhs.ids[i] != rhs.ids[i]) {
00017 return false;
00018 }
00019 }
00020
00021
00022 return true;
00023 }
00024
00025 bool operator==(const MKSingleValuePacket& lhs, const MKSingleValuePacket& rhs)
00026 {
00027 return (lhs.id == rhs.id) && (lhs.value == rhs.value);
00028 }
00029
00030
00031 bool isValidMKActiveIDs(const MKActiveIDs& activeIDs)
00032 {
00033 for (int i = 0; i < ACTIVEDATA_SIZE; i++) {
00034 if (activeIDs.ids[i] >= MKDataDefines::MKDATAIDS_NUM) {
00035 return false;
00036 }
00037 }
00038
00039 return true;
00040 }
00041
00042 const char* MKDataDefines::MKDATAIDS_NAMES[] = {
00043 "RawAccX",
00044 "RawAccY",
00045 "RawAccZ",
00046 "RawGyroX",
00047 "RawGyroY",
00048 "RawGyroZ",
00049
00050 "AccX",
00051 "AccY",
00052 "AccZ",
00053 "OmegaX",
00054 "OmegaY",
00055 "OmegaZ",
00056
00057 "BattVolt",
00058
00059 "OffsRAccX",
00060 "OffsRAccY",
00061 "OffsRAccZ",
00062 "GyrDriftX",
00063 "GyrDriftY",
00064 "GyrDriftZ",
00065
00066 "EstPitch",
00067 "EstRoll",
00068 "EstPitRat",
00069 "EstRolRat",
00070
00071 "PropGain",
00072 "DerivGain",
00073 "IntegGain",
00074 "YawRatGain",
00075 "YawAccGain",
00076
00077 "YawCtrTyp",
00078 "MirrPriod",
00079
00080 "TimeMs60",
00081
00082 "MirrActiv",
00083
00084 "MotState",
00085
00086 "DriftActiv",
00087
00088 "RcvCmdSec",
00089 "MaxRcvPer",
00090 "SenPktSec",
00091 "MaxSenPer",
00092 "FcStepSec",
00093 "MaxFcPer",
00094
00095 "RobotId",
00096 "FirmRev"
00097 };
00098
00099
00100
00101
00102
00103