bool
match_std_pkt(struct ofl_match_standard *a, struct ofl_match_standard *b) {
return pkt_wild32(a->in_port, b->in_port, a->wildcards, OFPFW_IN_PORT) &&
pkt_dladdr(a->dl_src, b->dl_src, a->dl_src_mask) &&
pkt_dladdr(a->dl_dst, b->dl_dst, a->dl_dst_mask) &&
pkt_dlvlan(a->dl_vlan, b->dl_vlan, a->wildcards) &&
pkt_dlvpcp(a->dl_vlan, a->dl_vlan_pcp, b->dl_vlan, b->dl_vlan_pcp, a->wildcards) &&
pkt_wild16(a->dl_type, b->dl_type, a->wildcards, OFPFW_DL_TYPE) &&
pkt_wild8 (a->nw_tos, b->nw_tos, a->wildcards, OFPFW_NW_TOS) &&
pkt_wild8 (a->nw_proto, b->nw_proto, a->wildcards, OFPFW_NW_PROTO) &&
pkt_mask32(a->nw_src, b->nw_src, a->nw_src_mask) &&
pkt_mask32(a->nw_dst, b->nw_dst, a->nw_dst_mask) &&
pkt_wild16(a->tp_src, b->tp_src, a->wildcards, OFPFW_TP_SRC) &&
pkt_wild16(a->tp_dst, b->tp_dst, a->wildcards, OFPFW_TP_DST) &&
pkt_wild32(a->mpls_label, b->mpls_label, a->wildcards, OFPFW_MPLS_LABEL) &&
pkt_wild8 (a->mpls_tc, b->mpls_tc, a->wildcards, OFPFW_MPLS_TC) &&
pkt_mask64(a->metadata, b->metadata, a->metadata_mask);
}
bool
packet_match(struct ofl_match *flow_match, struct ofl_match *packet){
struct ofl_match_tlv *f;
struct packet_fields *packet_f;
bool ret = false;
if (flow_match->header.length == 0){
return true;
}
/* Loop through the match fields */
HMAP_FOR_EACH(f, struct ofl_match_tlv, hmap_node, &flow_match->match_fields){
/* Check if the field is present in the packet */
// HMAP_FOR_EACH_WITH_HASH(packet_f, struct packet_fields, hmap_node, hash_int(f->header, 0), &packet->match_fields){
HMAP_FOR_EACH(packet_f, struct packet_fields, hmap_node, &packet->match_fields){
if (OXM_TYPE(f->header) == OXM_TYPE(packet_f->header)) {
int field_len = OXM_LENGTH(f->header);
bool has_mask = OXM_HASMASK(f->header);
ret = true;
if (has_mask)
{
field_len = field_len/2;
}
switch (field_len){
case (sizeof(uint8_t)):{
if (has_mask){
if (pkt_mask8(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (matches_8(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (sizeof(uint16_t)):{
if (OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_VLAN_VID)) {
if (*((uint16_t*)f->value) == OFPVID_NONE)
return false; // we have vlan tag when we expect none
else if (*((uint16_t*)f->value) == OFPVID_PRESENT && has_mask)
break; // this is the case where each vlan is a match
else
*((uint16_t*)f->value) &= VLAN_VID_MASK; // remove CFI bit
}
if (OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_IPV6_EXTHDR)){
if (ipv6_eh_match(f->value, packet_f->value) == 0) {
return false;
}
}
else if (has_mask){
if (pkt_mask16(f->value,f->value+ field_len, packet_f->value) == 0){
return false;
}
}
else {
if (pkt_match_16(f->value, packet_f->value) == 0){
return false;
}
}
break;
}
case (sizeof(uint32_t)):{
if (has_mask){
if (OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_IPV4_DST) || OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_IPV4_SRC)
|| OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_ARP_SPA) || OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_ARP_TPA)){
if (matches_mask32(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (pkt_mask32(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_IPV4_DST) || OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_IPV4_SRC)
||OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_ARP_SPA) || OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_ARP_TPA)){
if (matches_32(f->value, packet_f->value) == 0){
return false;
}
}
else {
if (pkt_match_32(f->value, packet_f->value) == 0){
return false;
}
}
break;
}
case (ETH_ADDR_LEN):{
if (has_mask){
if (eth_mask(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (eth_match(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (sizeof(uint64_t)):{
if (has_mask) {
if (pkt_mask64(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (matches_64(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (16):{
if (has_mask){
if (ipv6_mask(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (ipv6_match(f->value, packet_f->value) == 0){
return false;
}
break;
}
} // end of switch case
} // end of if (OXM_TYPE(f->header) == OXM_TYPE(packet_f->header))
} // end of packet_match loop
if (OXM_TYPE(f->header) == OXM_TYPE(OXM_OF_VLAN_VID))
if (*((uint16_t*)f->value) == OFPVID_NONE)
ret = true; // in case the packet has no vlan and this is what was expected
if (!ret)
return ret;
else ret = false;
} // end of flow_match loop
return true;
}
bool
packet_match(struct ofl_match *flow_match, struct ofl_match *packet){
struct ofl_match_tlv *f;
struct packet_fields *packet_f;
bool ret = false;
if (flow_match->header.length == 0){
return true;
}
/*TODO: Possible combinations of VLAN_ID and masks */
HMAP_FOR_EACH_WITH_HASH(f, struct ofl_match_tlv, hmap_node,hash_int(OXM_OF_VLAN_VID, 0), &flow_match->match_fields){
uint16_t *matchv = (uint16_t*) f->value;
/* Check if the field is present in the packet */
HMAP_FOR_EACH_WITH_HASH(packet_f, struct packet_fields, hmap_node, hash_int(OXM_OF_VLAN_VID, 0), &packet->match_fields){
/* Do not match packets with a VLAN Tag */
if (*matchv == OFPVID_NONE && !OXM_HASMASK(f->header))
return false;
ret = true;
}
if ((*matchv == OFPVID_PRESENT) & (OXM_HASMASK(f->header))){
uint16_t *maskv = (uint16_t*) f->value + 2;
if (*maskv == OFPVID_PRESENT && !ret )
return false;
}
}
/* Loop through the match fields */
HMAP_FOR_EACH(f, struct ofl_match_tlv, hmap_node, &flow_match->match_fields){
/* Check if the field is present in the packet */
HMAP_FOR_EACH_WITH_HASH(packet_f, struct packet_fields, hmap_node, hash_int(f->header, 0), &packet->match_fields){
int field_len = OXM_LENGTH(f->header);
bool has_mask = OXM_HASMASK(f->header);
ret = true;
switch (field_len){
case (sizeof(uint8_t)):{
if (has_mask){
if (pkt_mask8(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (matches_8(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (sizeof(uint16_t)):{
if (has_mask){
if (pkt_mask16(f->value,f->value+ field_len, packet_f->value) == 0){
return false;
}
}
else {
if (pkt_match_16(f->value, packet_f->value) == 0){
return false;
}
}
break;
}
case (sizeof(uint32_t)):{
if (has_mask){
if (f->header == OXM_OF_IPV4_DST || f->header == OXM_OF_IPV4_SRC
||f->header == OXM_OF_ARP_SPA || f->header == OXM_OF_ARP_TPA){
if (matches_mask32(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (pkt_mask32(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (f->header == OXM_OF_IPV4_DST || f->header == OXM_OF_IPV4_SRC
||f->header == OXM_OF_ARP_SPA || f->header == OXM_OF_ARP_TPA){
if (matches_32(f->value, packet_f->value) == 0){
return false;
}
}
else
if (pkt_match_32(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (ETH_ADDR_LEN):{
if (has_mask){
if (eth_mask(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (eth_match(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (sizeof(uint64_t)):{
if (has_mask) {
if (pkt_mask64(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (matches_64(f->value, packet_f->value) == 0){
return false;
}
break;
}
case (16):{
if (has_mask){
if (ipv6_mask(f->value,f->value + field_len, packet_f->value) == 0){
return false;
}
}
else
if (ipv6_match(f->value, packet_f->value) == 0){
return false;
}
break;
}
}
}
if (!ret)
return ret;
else ret = false;
}
return true;
}
