#include "action.h"
#include "cw.h"


int cw_out_radio_generic(struct conn *conn, struct cw_action_out *a, uint8_t * dst)
{
	int l=0;
	MAVLITER_DEFINE(it,conn->radios_upd);
	mavliter_foreach(&it){
		struct mbag_item *radio = mavliter_get(&it);
		if ( radio->type != MBAG_MBAG ) {
			continue;
		}

		/* Size for msg elem header depends on 
		   vendor specific payload */
		int start = a->vendor_id ? 10 : 4;

		uint8_t * d = dst+l;



		struct mbag_item * item = mbag_get(radio->data,a->item_id);
		if (!item){
			continue;
		}
		int len=0;
		len += cw_put_byte(d+start,radio->iid);
		len += cw_put_mbag_item(d + start+1, item);

		if (a->vendor_id)
			l+= len + cw_put_elem_vendor_hdr(d, a->vendor_id, a->elem_id, len);
		else
			l += len + cw_put_elem_hdr(d, a->elem_id, len);



	}
	return l;

}