func (self StratosOxm) Match(data ofp4sw.Frame, key ofp4sw.OxmKey, payload ofp4sw.OxmPayload) (bool, error) {
switch k := key.(type) {
case OxmKeyStratos:
switch k.Field {
case oxm.STRATOS_OXM_FIELD_BASIC:
fetch11 := func() *layers.Dot11 {
for _, layer := range data.Layers() {
switch l := layer.(type) {
case *layers.Dot11:
return l
}
}
return nil
}
fetchIeList := func() (ret []*layers.Dot11InformationElement) {
for _, layer := range data.Layers() {
switch l := layer.(type) {
case *layers.Dot11InformationElement:
ret = append(ret, l)
}
}
return
}
switch k.Type {
case oxm.STROXM_BASIC_DOT11:
p := payload.(ofp4sw.OxmValueMask)
var want uint8
if len(p.Value) > 0 {
want = p.Value[0]
}
var have uint8
if val, ok := data.Oob[key]; ok && val != nil {
if v, ok := val.(ofp4sw.OxmValueMask); ok && len(v.Value) > 0 {
have = v.Value[0]
}
}
switch want {
case 1:
return have == 1, nil
case 2:
return have != 1, nil
default:
return true, nil
}
case oxm.STROXM_BASIC_DOT11_FRAME_CTRL:
if m := fetch11(); m != nil {
p := payload.(ofp4sw.OxmValueMask)
v := []byte{
uint8(m.Type<<2) | m.Proto,
uint8(m.Flags),
}
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And(v, p.Mask)), nil
} else {
return bytes.Equal(p.Value, v), nil
}
}
case oxm.STROXM_BASIC_DOT11_ADDR1:
if m := fetch11(); m != nil {
p := payload.(ofp4sw.OxmValueMask)
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And([]byte(m.Address1), p.Mask)), nil
} else {
return bytes.Equal(p.Value, []byte(m.Address1)), nil
}
}
case oxm.STROXM_BASIC_DOT11_ADDR2:
if m := fetch11(); m != nil {
p := payload.(ofp4sw.OxmValueMask)
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And([]byte(m.Address2), p.Mask)), nil
} else {
return bytes.Equal(p.Value, []byte(m.Address2)), nil
}
}
case oxm.STROXM_BASIC_DOT11_ADDR3:
if m := fetch11(); m != nil {
p := payload.(ofp4sw.OxmValueMask)
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And([]byte(m.Address3), p.Mask)), nil
} else {
return bytes.Equal(p.Value, []byte(m.Address3)), nil
}
}
case oxm.STROXM_BASIC_DOT11_ADDR4:
if m := fetch11(); m != nil {
p := payload.(ofp4sw.OxmValueMask)
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And([]byte(m.Address4), p.Mask)), nil
} else {
return bytes.Equal(p.Value, []byte(m.Address4)), nil
}
}
case oxm.STROXM_BASIC_DOT11_SSID:
for _, l := range fetchIeList() {
if l.ID == 0 {
p := payload.(ofp4sw.OxmValueMask)
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And(l.Info, p.Mask)), nil
} else {
return bytes.Equal(p.Value, l.Info), nil
}
}
}
return false, nil
case oxm.STROXM_BASIC_DOT11_ACTION_CATEGORY:
// XXX: HT field handling is missing in gopacket
if m := fetch11(); m != nil && m.Type.MainType() == layers.Dot11TypeMgmt {
p := payload.(ofp4sw.OxmValueMask)
return bytes.HasPrefix(m.Payload, p.Value), nil
}
case oxm.STROXM_BASIC_DOT11_PUBLIC_ACTION:
if m := fetch11(); m != nil && m.Type.MainType() == layers.Dot11TypeMgmt && m.Payload[0] == 4 { // Public Action
p := payload.(ofp4sw.OxmValueMask)
v := m.Payload[1] // Public Action field value
if len(p.Mask) > 0 {
v &= p.Mask[0]
}
return v == p.Value[0], nil
}
case oxm.STROXM_BASIC_DOT11_TAG:
ies := fetchIeList()
for _, v := range payload.(OxmMultiValue).Values {
for _, ie := range ies {
if v[0] == uint8(ie.ID) {
return true, nil
}
}
}
return false, nil
case oxm.STROXM_BASIC_DOT11_TAG_VENDOR:
ies := fetchIeList()
for _, v := range payload.(OxmMultiValue).Values {
for _, ie := range ies {
if ie.ID == 221 && bytes.HasPrefix(ie.OUI, v) {
return true, nil
}
}
}
return false, nil
default:
return false, fmt.Errorf("unsupported oxm experimenter type")
}
case oxm.STRATOS_OXM_FIELD_RADIOTAP:
p := payload.(ofp4sw.OxmValueMask)
if val, ok := data.Oob[key]; ok && val != nil {
if v, ok := val.(ofp4sw.OxmValueMask); ok && len(v.Value) > 0 {
if len(p.Mask) > 0 {
return bytes.Equal(p.Value, bytes2.And(v.Value, p.Mask)), nil
} else {
return bytes.Equal(p.Value, v.Value), nil
}
}
}
default:
return false, fmt.Errorf("unsupported oxm experimenter field")
}
default:
return false, fmt.Errorf("unknown oxm key")
}
return false, nil
}
func (self StratosOxm) SetField(data *ofp4sw.Frame, key ofp4sw.OxmKey, payload ofp4sw.OxmPayload) error {
switch k := key.(type) {
case OxmKeyStratos:
switch k.Field {
case oxm.STRATOS_OXM_FIELD_BASIC:
p := payload.(ofp4sw.OxmValueMask)
fetch11 := func() *layers.Dot11 {
for _, layer := range data.Layers() {
switch l := layer.(type) {
case *layers.Dot11:
return l
}
}
return nil
}
fetchIeList := func() (ret []*layers.Dot11InformationElement) {
for _, layer := range data.Layers() {
switch l := layer.(type) {
case *layers.Dot11InformationElement:
ret = append(ret, l)
}
}
return
}
switch k.Type {
case oxm.STROXM_BASIC_DOT11:
data.Oob[key] = ofp4sw.OxmValueMask{
Value: p.Value,
}
case oxm.STROXM_BASIC_DOT11_FRAME_CTRL:
if m := fetch11(); m != nil {
v := []byte{
uint8(m.Type<<2) | m.Proto,
uint8(m.Flags),
}
v = bytes2.Or(p.Value, bytes2.And(v, p.Mask))
m.Proto = v[0] & 0x03
m.Type = layers.Dot11Type(v[0] >> 2)
m.Flags = layers.Dot11Flags(v[1])
}
case oxm.STROXM_BASIC_DOT11_ADDR1:
if m := fetch11(); m != nil {
if len(p.Mask) > 0 {
m.Address1 = bytes2.Or(p.Value, bytes2.And([]byte(m.Address1), p.Mask))
} else {
m.Address1 = p.Value
}
}
case oxm.STROXM_BASIC_DOT11_ADDR2:
if m := fetch11(); m != nil {
if len(p.Mask) > 0 {
m.Address2 = bytes2.Or(p.Value, bytes2.And([]byte(m.Address2), p.Mask))
} else {
m.Address2 = p.Value
}
}
case oxm.STROXM_BASIC_DOT11_ADDR3:
if m := fetch11(); m != nil {
if len(p.Mask) > 0 {
m.Address3 = bytes2.Or(p.Value, bytes2.And([]byte(m.Address3), p.Mask))
} else {
m.Address3 = p.Value
}
}
case oxm.STROXM_BASIC_DOT11_ADDR4:
if m := fetch11(); m != nil {
if len(p.Mask) > 0 {
m.Address4 = bytes2.Or(p.Value, bytes2.And([]byte(m.Address4), p.Mask))
} else {
m.Address4 = p.Value
}
}
case oxm.STROXM_BASIC_DOT11_SSID:
for _, l := range fetchIeList() {
if l.ID == 0 {
if len(p.Mask) > 0 {
l.Info = bytes2.Or(p.Value, bytes2.And(l.Info, p.Mask))
} else {
l.Info = p.Value
}
}
}
default:
return fmt.Errorf("unsupported oxm experimenter type")
}
case oxm.STRATOS_OXM_FIELD_RADIOTAP:
p := payload.(ofp4sw.OxmValueMask)
if v, ok := data.Oob[key].(ofp4sw.OxmValueMask); !ok {
data.Oob[key] = payload
} else if len(p.Mask) > 0 {
v.Value = bytes2.Or(p.Value, bytes2.And(v.Value, p.Mask))
data.Oob[key] = v
} else {
data.Oob[key] = ofp4sw.OxmValueMask{
Value: p.Value,
}
}
default:
return fmt.Errorf("unsupported oxm experimenter field")
}
default:
return fmt.Errorf("unknown oxm key")
}
return nil
}