Remove targetlen, remove copying when extracting sub iterators.
This commit is contained in:
127
nl80211.py
127
nl80211.py
@@ -7,26 +7,37 @@ import struct
|
|||||||
|
|
||||||
|
|
||||||
class Iterator(object):
|
class Iterator(object):
|
||||||
def __init__(self, data):
|
def __init__(self, data, offset=0, length=None):
|
||||||
self.data = data
|
self.data = data
|
||||||
self.offset = 0
|
self.offset = offset
|
||||||
|
self.length = len(self.data) if length is None else length
|
||||||
|
assert self.length <= len(self.data)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self):
|
||||||
data = self.data[self.offset:]
|
data = self.data[self.offset:self.length]
|
||||||
return '(%d bytes): %r' % (len(data), data)
|
return '(%d bytes): %r' % (len(data), data)
|
||||||
|
|
||||||
def Advance(self, offset_incr):
|
def Advance(self, offset_incr):
|
||||||
assert self.offset + offset_incr <= len(self.data)
|
assert offset_incr <= self.Remaining(), 'Want %d bytes, have %d' % (offset_incr, self.Remaining())
|
||||||
self.offset += offset_incr
|
self.offset += offset_incr
|
||||||
|
|
||||||
def Extract(self, length):
|
def Extract(self, length):
|
||||||
assert self.offset + length <= len(self.data), 'Want %d bytes, have %d' % (length, len(self.data) - self.offset)
|
assert length <= self.Remaining(), 'Want %d bytes, have %d' % (length, self.Remaining())
|
||||||
ret = self.data[self.offset:self.offset + length]
|
ret = self.data[self.offset:self.offset + length]
|
||||||
self.Advance(length)
|
self.Advance(length)
|
||||||
return ret
|
return ret
|
||||||
|
|
||||||
|
def ExtractIterator(self, length):
|
||||||
|
assert length <= self.Remaining(), 'Want %d bytes, have %d' % (length, self.Remaining())
|
||||||
|
ret = Iterator(self.data, self.offset, self.offset + length)
|
||||||
|
self.Advance(length)
|
||||||
|
return ret
|
||||||
|
|
||||||
|
def Remaining(self):
|
||||||
|
return self.length - self.offset
|
||||||
|
|
||||||
def AtEnd(self):
|
def AtEnd(self):
|
||||||
return self.offset == len(self.data)
|
return not self.Remaining()
|
||||||
|
|
||||||
|
|
||||||
class Accumulator(object):
|
class Accumulator(object):
|
||||||
@@ -44,9 +55,7 @@ class Accumulator(object):
|
|||||||
|
|
||||||
|
|
||||||
class SingleStructParser(struct.Struct):
|
class SingleStructParser(struct.Struct):
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
if targetlen is not None:
|
|
||||||
assert self.size == targetlen, 'Actual bytes: %d, expected bytes: %d' % (targetlen, self.size)
|
|
||||||
values = self.unpack_from(iterator.data, iterator.offset)
|
values = self.unpack_from(iterator.data, iterator.offset)
|
||||||
iterator.Advance(self.size)
|
iterator.Advance(self.size)
|
||||||
assert len(values) == 1
|
assert len(values) == 1
|
||||||
@@ -61,9 +70,7 @@ class StructParser(struct.Struct):
|
|||||||
super(StructParser, self).__init__(format)
|
super(StructParser, self).__init__(format)
|
||||||
self._fields = fields
|
self._fields = fields
|
||||||
|
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
if targetlen is not None:
|
|
||||||
assert self.size == targetlen, 'Actual bytes: %d, expected bytes: %d' % (targetlen, self.size)
|
|
||||||
values = self.unpack_from(iterator.data, iterator.offset)
|
values = self.unpack_from(iterator.data, iterator.offset)
|
||||||
iterator.Advance(self.size)
|
iterator.Advance(self.size)
|
||||||
return dict(zip(self._fields, values))
|
return dict(zip(self._fields, values))
|
||||||
@@ -76,16 +83,15 @@ class StructParser(struct.Struct):
|
|||||||
|
|
||||||
|
|
||||||
class StringParser(object):
|
class StringParser(object):
|
||||||
def Unpack(self, iterator, targetlen):
|
def Unpack(self, iterator):
|
||||||
return iterator.Extract(targetlen)
|
return iterator.Extract(iterator.Remaining())
|
||||||
|
|
||||||
def Pack(self, accumulator, value):
|
def Pack(self, accumulator, value):
|
||||||
accumulator.Append(value)
|
accumulator.Append(value)
|
||||||
|
|
||||||
|
|
||||||
class EmptyParser(object):
|
class EmptyParser(object):
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
assert not targetlen
|
|
||||||
return True
|
return True
|
||||||
|
|
||||||
def Pack(self, accumulator, value=None):
|
def Pack(self, accumulator, value=None):
|
||||||
@@ -103,17 +109,17 @@ class Attribute(object):
|
|||||||
super(Attribute, self).__init__()
|
super(Attribute, self).__init__()
|
||||||
self._attributes = attributes
|
self._attributes = attributes
|
||||||
|
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
nlattr = self._nlattr.Unpack(iterator)
|
nlattr = self._nlattr.Unpack(iterator)
|
||||||
if targetlen is not None:
|
|
||||||
assert nlattr['len'] == targetlen
|
|
||||||
value = iterator.data[iterator.offset:iterator.offset + nlattr['len'] - self._nlattr.size]
|
value = iterator.data[iterator.offset:iterator.offset + nlattr['len'] - self._nlattr.size]
|
||||||
name, sub_parser = self._attributes.get(nlattr['type'], (None, None))
|
name, sub_parser = self._attributes.get(nlattr['type'], (None, None))
|
||||||
assert sub_parser, 'Unknown attribute type %d, len %d' % (nlattr['type'], nlattr['len'])
|
assert sub_parser, 'Unknown attribute type %d, len %d' % (nlattr['type'], nlattr['len'])
|
||||||
sub_len = nlattr['len'] - self._nlattr.size
|
sub_len = nlattr['len'] - self._nlattr.size
|
||||||
|
sub_iterator = iterator.ExtractIterator(sub_len)
|
||||||
ret = {
|
ret = {
|
||||||
name: sub_parser.Unpack(iterator, sub_len)
|
name: sub_parser.Unpack(sub_iterator)
|
||||||
}
|
}
|
||||||
|
assert sub_iterator.AtEnd(), '%d bytes remaining' % sub_iterator.Remaining()
|
||||||
|
|
||||||
padding = ((nlattr['len'] + 4 - 1) & ~3) - nlattr['len']
|
padding = ((nlattr['len'] + 4 - 1) & ~3) - nlattr['len']
|
||||||
iterator.Advance(padding)
|
iterator.Advance(padding)
|
||||||
@@ -134,9 +140,7 @@ class Attributes(object):
|
|||||||
self._attribute_idx = dict((v[0], k) for k, v in attributes.iteritems())
|
self._attribute_idx = dict((v[0], k) for k, v in attributes.iteritems())
|
||||||
self._attribute = Attribute(attributes)
|
self._attribute = Attribute(attributes)
|
||||||
|
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
if targetlen is not None:
|
|
||||||
iterator = Iterator(iterator.Extract(targetlen))
|
|
||||||
ret = {}
|
ret = {}
|
||||||
while not iterator.AtEnd():
|
while not iterator.AtEnd():
|
||||||
ret.update(self._attribute.Unpack(iterator))
|
ret.update(self._attribute.Unpack(iterator))
|
||||||
@@ -154,13 +158,14 @@ class Array(object):
|
|||||||
super(Array, self).__init__()
|
super(Array, self).__init__()
|
||||||
self._child = child
|
self._child = child
|
||||||
|
|
||||||
def Unpack(self, iterator, targetlen=None):
|
def Unpack(self, iterator):
|
||||||
if targetlen is not None:
|
|
||||||
iterator = Iterator(iterator.Extract(targetlen))
|
|
||||||
ret = []
|
ret = []
|
||||||
while not iterator.AtEnd():
|
while not iterator.AtEnd():
|
||||||
hdr = self._arrayhdr.Unpack(iterator)
|
hdr = self._arrayhdr.Unpack(iterator)
|
||||||
ret.append(self._child.Unpack(iterator, hdr['len'] - self._arrayhdr.size))
|
sub_len = hdr['len'] - self._arrayhdr.size
|
||||||
|
sub_iterator = iterator.ExtractIterator(sub_len)
|
||||||
|
ret.append(self._child.Unpack(sub_iterator))
|
||||||
|
assert sub_iterator.AtEnd(), '%d bytes remaining' % sub_iterator.Remaining()
|
||||||
return ret
|
return ret
|
||||||
|
|
||||||
|
|
||||||
@@ -258,42 +263,52 @@ STA_FLAG_TDLS_PEER = 1 << 5
|
|||||||
STA_FLAG_ASSOCIATED = 1 << 6
|
STA_FLAG_ASSOCIATED = 1 << 6
|
||||||
|
|
||||||
|
|
||||||
int_genquery = Accumulator()
|
class Connection(object):
|
||||||
genlmsghdr.Pack(
|
def __init__(self):
|
||||||
int_genquery,
|
self._sock = socket.socket(socket.AF_NETLINK, socket.SOCK_DGRAM, 16)
|
||||||
cmd=CMD_GET_STATION,
|
self._sock.bind((0, 0))
|
||||||
version=0,
|
|
||||||
reserved=0)
|
|
||||||
nl80211_attr.Pack(
|
|
||||||
int_genquery,
|
|
||||||
ifindex=6)
|
|
||||||
genquery = Accumulator()
|
|
||||||
nlmsghdr.Pack(
|
|
||||||
genquery,
|
|
||||||
length=nlmsghdr.size + len(int_genquery),
|
|
||||||
type=20, # XXX
|
|
||||||
flags=F_REQUEST | F_ACK | F_DUMP,
|
|
||||||
seq=random.randint(0, 2 ** 32 - 1),
|
|
||||||
pid=os.getpid())
|
|
||||||
genquery.Append(str(int_genquery))
|
|
||||||
|
|
||||||
sock = socket.socket(socket.AF_NETLINK, socket.SOCK_DGRAM, 16)
|
def Send(self, msg):
|
||||||
sock.bind((0, 0))
|
self._sock.send(msg)
|
||||||
|
|
||||||
|
def RecvAndUnpack(self):
|
||||||
|
data = self._sock.recv(4096)
|
||||||
|
iterator = Iterator(data)
|
||||||
|
myhdr = nlmsghdr.Unpack(iterator)
|
||||||
|
print 'nlmsghdr: %s' % myhdr
|
||||||
|
int_iterator = iterator.ExtractIterator(myhdr['length'] - nlmsghdr.size)
|
||||||
|
print 'genlmsghdr: %s' % genlmsghdr.Unpack(int_iterator)
|
||||||
|
print 'ctrl_attr: %s' % ctrl_attr.Unpack(int_iterator)
|
||||||
|
|
||||||
|
|
||||||
|
#int_genquery = Accumulator()
|
||||||
|
#genlmsghdr.Pack(
|
||||||
|
# int_genquery,
|
||||||
|
# cmd=CMD_GET_STATION,
|
||||||
|
# version=0,
|
||||||
|
# reserved=0)
|
||||||
|
#nl80211_attr.Pack(
|
||||||
|
# int_genquery,
|
||||||
|
# ifindex=6)
|
||||||
|
#genquery = Accumulator()
|
||||||
|
#nlmsghdr.Pack(
|
||||||
|
# genquery,
|
||||||
|
# length=nlmsghdr.size + len(int_genquery),
|
||||||
|
# type=20, # XXX
|
||||||
|
# flags=F_REQUEST | F_ACK | F_DUMP,
|
||||||
|
# seq=random.randint(0, 2 ** 32 - 1),
|
||||||
|
# pid=os.getpid())
|
||||||
|
#genquery.Append(str(int_genquery))
|
||||||
|
|
||||||
#sock.send(str(genquery))
|
#sock.send(str(genquery))
|
||||||
#data = sock.recv(4096)
|
#data = sock.recv(4096)
|
||||||
#
|
|
||||||
#iterator = Iterator(data)
|
#iterator = Iterator(data)
|
||||||
#print 'nlmsghdr: %s' % nlmsghdr.Unpack(iterator)
|
#print 'nlmsghdr: %s' % nlmsghdr.Unpack(iterator)
|
||||||
#print 'genlmsghdr: %s' % genlmsghdr.Unpack(iterator)
|
#print 'genlmsghdr: %s' % genlmsghdr.Unpack(iterator)
|
||||||
#print 'nl80211_attr: %s' % nl80211_attr.Unpack(iterator)
|
#print 'nl80211_attr: %s' % nl80211_attr.Unpack(iterator)
|
||||||
|
|
||||||
query = '\24\0\0\0\20\0\5\3a\6\256T\v\17\0\0\3\1\0\0'
|
query = '\24\0\0\0\20\0\5\3a\6\256T\v\17\0\0\3\1\0\0'
|
||||||
sock.send(query)
|
conn = Connection()
|
||||||
data = sock.recv(4096)
|
conn.Send(query)
|
||||||
iterator = Iterator(data)
|
conn.RecvAndUnpack()
|
||||||
myhdr = nlmsghdr.Unpack(iterator)
|
|
||||||
print 'nlmsghdr: %s' % myhdr
|
|
||||||
int_iterator = Iterator(iterator.Extract(myhdr['length'] - nlmsghdr.size))
|
|
||||||
print 'genlmsghdr: %s' % genlmsghdr.Unpack(int_iterator)
|
|
||||||
print 'ctrl_attr: %s' % ctrl_attr.Unpack(int_iterator)
|
|
||||||
|
|||||||
Reference in New Issue
Block a user