/* Send experimenter multipart reply. */ STATIC lagopus_result_t ofp_experimenter_mp_reply_create( struct channel *channel, struct pbuf_list **pbuf_list, struct ofp_header *xid_header, struct ofp_experimenter_multipart_header *exper_req) { lagopus_result_t ret = LAGOPUS_RESULT_ANY_FAILURES; uint16_t tmp_length = 0; uint16_t length = 0; struct ofp_multipart_reply mp_reply; struct pbuf *pbuf = NULL; struct ofp_experimenter_multipart_header exper_reply; if (channel != NULL && pbuf_list != NULL && xid_header != NULL && exper_req != NULL) { /* alloc */ *pbuf_list = pbuf_list_alloc(); if (*pbuf_list != NULL) { pbuf = pbuf_list_last_get(*pbuf_list); if (pbuf != NULL) { pbuf_plen_set(pbuf, pbuf_size_get(pbuf)); /* Fill in header. */ memset(&mp_reply, 0, sizeof(mp_reply)); ofp_header_set(&mp_reply.header, channel_version_get(channel), OFPT_MULTIPART_REPLY, tmp_length, xid_header->xid); mp_reply.type = OFPMP_EXPERIMENTER; mp_reply.flags = 0; /* Encode multipart reply. */ ret = ofp_multipart_reply_encode(pbuf, &mp_reply); if (ret == LAGOPUS_RESULT_OK) { exper_reply.experimenter = exper_req->experimenter; exper_reply.exp_type = exper_req->exp_type; /* Encode message. */ ret = ofp_experimenter_multipart_header_encode( pbuf, &exper_reply); if (ret == LAGOPUS_RESULT_OK) { /* set length for last pbuf. */ ret = pbuf_length_get(pbuf, &length); if (ret == LAGOPUS_RESULT_OK) { ret = ofp_header_length_set(pbuf, length); if (ret == LAGOPUS_RESULT_OK) { pbuf_plen_reset(pbuf); ret = LAGOPUS_RESULT_OK; } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } else { lagopus_msg_warning("Can't allocate pbuf.\n"); ret = LAGOPUS_RESULT_NO_MEMORY; } } else { lagopus_msg_warning("Can't allocate pbuf_list.\n"); ret = LAGOPUS_RESULT_NO_MEMORY; } if (ret != LAGOPUS_RESULT_OK && *pbuf_list != NULL) { pbuf_list_free(*pbuf_list); *pbuf_list = NULL; } } else { ret = LAGOPUS_RESULT_INVALID_ARGS; } return ret; }
STATIC lagopus_result_t ofp_meter_features_reply_create(struct channel *channel, struct pbuf_list **pbuf_list, struct ofp_meter_features *ofp_meter_features, struct ofp_header *xid_header) { lagopus_result_t res = LAGOPUS_RESULT_ANY_FAILURES; uint16_t length = 0; struct pbuf *pbuf = NULL; struct ofp_multipart_reply ofpmp_reply; /* check params */ if (channel != NULL && pbuf_list != NULL && ofp_meter_features != NULL && xid_header != NULL) { /* alloc */ *pbuf_list = NULL; *pbuf_list = pbuf_list_alloc(); if (*pbuf_list != NULL) { /* alloc&get tail of pbuf_list */ pbuf = pbuf_list_last_get(*pbuf_list); if (pbuf != NULL) { /* set data. */ memset(&ofpmp_reply, 0, sizeof(ofpmp_reply)); ofp_header_set(&ofpmp_reply.header, channel_version_get(channel), OFPT_MULTIPART_REPLY, 0, /* length set in ofp_header_length_set() */ xid_header->xid); ofpmp_reply.type = OFPMP_METER_FEATURES; /* encode message. */ pbuf_plen_set(pbuf, pbuf_size_get(pbuf)); res = ofp_multipart_reply_encode_list(*pbuf_list, &pbuf, &ofpmp_reply); if (res == LAGOPUS_RESULT_OK) { res = ofp_meter_features_encode_list(*pbuf_list, &pbuf, ofp_meter_features); if (res == LAGOPUS_RESULT_OK) { /* set packet length */ res = pbuf_length_get(pbuf, &length); if (res == LAGOPUS_RESULT_OK) { res = ofp_header_length_set(pbuf, length); if (res == LAGOPUS_RESULT_OK) { pbuf_plen_reset(pbuf); } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(res)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(res)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(res)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(res)); } } else { res = LAGOPUS_RESULT_NO_MEMORY; } } else { res = LAGOPUS_RESULT_NO_MEMORY; } } else { res = LAGOPUS_RESULT_INVALID_ARGS; } return res; }