lagopus_result_t ofp_get_async_request_handle(struct channel *channel, struct pbuf *pbuf, struct ofp_header *xid_header, struct ofp_error *error) { lagopus_result_t ret = LAGOPUS_RESULT_ANY_FAILURES; struct pbuf *send_pbuf = NULL; /* check params */ if (channel != NULL && pbuf != NULL && xid_header != NULL && error != NULL) { ret = pbuf_plen_check(pbuf, xid_header->length); if (ret == LAGOPUS_RESULT_OK) { /* Parse packet. */ ret = ofp_header_handle(channel, pbuf, error); if (ret == LAGOPUS_RESULT_OK) { /* dump trace. */ get_async_request_trace(xid_header); /* Reply send.*/ ret = ofp_get_async_reply_create(channel, &send_pbuf, xid_header); if (ret == LAGOPUS_RESULT_OK) { channel_send_packet(channel, send_pbuf); } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); ofp_error_set(error, OFPET_BAD_REQUEST, OFPBRC_BAD_LEN); ret = LAGOPUS_RESULT_OFP_ERROR; } if (ret != LAGOPUS_RESULT_OK && send_pbuf != NULL) { channel_pbuf_list_unget(channel, send_pbuf); } } else { lagopus_msg_warning("bad length.\n"); ofp_error_set(error, OFPET_BAD_REQUEST, OFPBRC_BAD_LEN); ret = LAGOPUS_RESULT_OFP_ERROR; } } else { ret = LAGOPUS_RESULT_INVALID_ARGS; } return ret; }
lagopus_result_t ofp_set_async_handle(struct channel *channel, struct pbuf *pbuf, struct ofp_header *xid_header, struct ofp_error *error) { lagopus_result_t ret = LAGOPUS_RESULT_ANY_FAILURES; struct ofp_async_config async_config; if (channel != NULL && pbuf != NULL && xid_header != NULL && error != NULL) { ret = pbuf_plen_check(pbuf, xid_header->length); if (ret == LAGOPUS_RESULT_OK) { /* Parse packet. */ ret = ofp_async_config_decode(pbuf, &async_config); if (ret == LAGOPUS_RESULT_OK) { /* dump trace. */ set_async_trace(&async_config); /* Copy packet_in_mask, port_status_mask, flow_removed_mask. */ channel_role_mask_set(channel, &async_config); } else { lagopus_msg_warning("FAILED : ofp_config_decode (%s).\n", lagopus_error_get_string(ret)); ofp_error_set(error, OFPET_BAD_REQUEST, OFPBRC_BAD_LEN); ret = LAGOPUS_RESULT_OFP_ERROR; } } else { lagopus_msg_warning("bad length.\n"); ofp_error_set(error, OFPET_BAD_REQUEST, OFPBRC_BAD_LEN); ret = LAGOPUS_RESULT_OFP_ERROR; } } else { ret = LAGOPUS_RESULT_INVALID_ARGS; } return ret; }
/* SEND */ STATIC lagopus_result_t ofp_packet_in_create(struct packet_in *packet_in, struct pbuf **pbuf) { lagopus_result_t ret = LAGOPUS_RESULT_ANY_FAILURES; uint16_t miss_send_len; uint16_t length = 0; uint16_t remain_length = 0; uint16_t match_total_len = 0; uint8_t tmp_version = 0x00; uint32_t tmp_xid = 0x00; uint16_t tmp_length = 0; if (packet_in != NULL && packet_in->data != NULL && pbuf != NULL) { /* alloc */ *pbuf = pbuf_alloc(OFP_PACKET_MAX_SIZE); if (*pbuf != NULL) { pbuf_plen_set(*pbuf, OFP_PACKET_MAX_SIZE); /* set total_len. */ ret = pbuf_length_get(packet_in->data, &length); if (ret == LAGOPUS_RESULT_OK) { packet_in->ofp_packet_in.total_len = length; /* Fill in header. */ /* tmp_* is replaced later. */ ofp_header_set(&packet_in->ofp_packet_in.header, tmp_version, OFPT_PACKET_IN, tmp_length, tmp_xid); ret = ofp_packet_in_encode(*pbuf, &packet_in->ofp_packet_in); if (ret == LAGOPUS_RESULT_OK) { ret = ofp_match_list_encode(NULL, *pbuf, &packet_in->match_list, &match_total_len); if (ret == LAGOPUS_RESULT_OK) { /* Cut packet. */ remain_length = (uint16_t) pbuf_plen_get(*pbuf); if (packet_in->ofp_packet_in.buffer_id == OFP_NO_BUFFER) { miss_send_len = remain_length; } else { miss_send_len = packet_in->miss_send_len; } if (length < miss_send_len) { miss_send_len = length; } /* exist data */ if (miss_send_len != 0) { /* add padding */ ret = ofp_padding_add(*pbuf, OFP_PACKET_IN_PAD); if (ret == LAGOPUS_RESULT_OK) { /* Cut packet. (remain_length) */ if (miss_send_len + OFP_PACKET_IN_PAD > remain_length) { miss_send_len = remain_length; } if (pbuf_plen_check(*pbuf, miss_send_len) != LAGOPUS_RESULT_OK) { lagopus_msg_warning("FAILED : over data length.\n"); ret = LAGOPUS_RESULT_OUT_OF_RANGE; } else { /* copy data. */ ret = pbuf_copy_with_length(*pbuf, packet_in->data, miss_send_len); if (ret == LAGOPUS_RESULT_OK) { pbuf_plen_reset(*pbuf); } else { lagopus_msg_warning("FAILED (%s).\n", lagopus_error_get_string(ret)); } } } else { lagopus_msg_warning("FAILED : over padding length.\n"); } } else { 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("Can't allocate pbuf.\n"); ret = LAGOPUS_RESULT_NO_MEMORY; } /* free. */ if (ret != LAGOPUS_RESULT_OK && *pbuf != NULL) { pbuf_free(*pbuf); *pbuf = NULL; } } else { ret = LAGOPUS_RESULT_INVALID_ARGS; } return ret; }