mavlink_get_info.h

Go to the documentation of this file.

#ifndef  _MAVLINK_GET_INFO_H_
#define  _MAVLINK_GET_INFO_H_

#ifdef MAVLINK_USE_MESSAGE_INFO
#define MAVLINK_HAVE_GET_MESSAGE_INFO
/*
  return the message_info struct for a message
*/
MAVLINK_HELPER const mavlink_message_info_t *mavlink_get_message_info(const mavlink_message_t *msg)
{
        static const mavlink_message_info_t mavlink_message_info[] = MAVLINK_MESSAGE_INFO;
        /*
          use a bisection search to find the right entry. A perfect hash may be better
          Note that this assumes the table is sorted with primary key msgid
        */
        uint32_t msgid = msg->msgid;
        uint32_t low=0, high=sizeof(mavlink_message_info)/sizeof(mavlink_message_info[0]);
        while (low < high) {
            uint32_t mid = (low+1+high)/2;
            if (msgid < mavlink_message_info[mid].msgid) {
                high = mid-1;
                continue;
            }
            if (msgid > mavlink_message_info[mid].msgid) {
                low = mid;
                continue;
            }
            low = mid;
            break;
        }
        return &mavlink_message_info[low];
}
#endif // MAVLINK_USE_MESSAGE_INFO

#endif // _MAVLINK_GET_INFO_H_