netarch/__init__.py

260 lines
5.8 KiB
Python
Executable File

#! /usr/bin/python
# -*- coding: utf-8 -*-
## 2008 Massive Blowout
import sys
import struct
printable = 'abcdefghijklmnopqrstuvwxyzABCDEFGHIJKLMNOPQRSTUVWXYZ1234567890!@#$%^&*()[]{}`~/=-\\?+|\',."<>: '
def unpack(fmt, buf):
"""Unpack buf based on fmt, return the rest as a string."""
size = struct.calcsize(fmt)
vals = struct.unpack(fmt, str(buf[:size]))
return vals + (buf[size:],)
class HexDumper:
def __init__(self, fd=sys.stdout):
self.fd = fd
self.offset = 0
self.buf = []
def _to_printable(self, c):
if not c:
return ''
elif c in printable:
return c
elif c == '\0':
return ''
elif c == '\r':
return ''
elif c == '\n':
return ''
else:
return '·'
def _flush(self):
if not self.buf:
return
o = []
for c in self.buf:
if c:
o.append('%02x' % ord(c))
else:
o.append('--')
o += ([' '] * (16 - len(self.buf)))
p = [self._to_printable(c) for c in self.buf]
self.fd.write('%08x ' % self.offset)
self.fd.write(' '.join(o[:8]))
self.fd.write(' ')
self.fd.write(' '.join(o[8:]))
self.fd.write('')
self.fd.write(''.join(p))
self.fd.write('\n')
self.buf = []
self.offset += 16
def dump_chr(self, c):
self.buf.append(c)
if len(self.buf) == 16:
self._flush()
def dump_drop(self):
self.buf.append(None)
if len(self.buf) == 16:
self._flush()
def finish(self):
self._flush()
self.fd.write('%08x\n' % self.offset)
def hexdump(buf, f=sys.stdout):
"Print a hex dump of buf"
d = HexDumper()
for c in buf:
d.dump_chr(c)
d.finish()
def cstring(buf):
"Return buf if buf were a C-style (NULL-terminate) string"
i = buf.index('\0')
return buf[:i]
def md5sum(txt):
return md5.new(txt).hexdigest()
def assert_equal(a, b):
assert a == b, ('%r != %r' % (a, b))
def assert_in(a, *b):
assert a in b, ('%r not in %r' % (a, b))
##
## Binary stuff
##
class BitVector:
def __init__(self, i=0, length=None):
if type(i) == type(1):
self._val = i
if length is not None:
self._len = length
else:
self._len = 0
while i > 0:
i >>= 1
self._len += 1
else:
self._val = 0
for c in i:
self._val <<= 8
self._val += ord(c)
if length is not None:
self._len = length
else:
self._len = len(i) * 8
def __len__(self):
return self._len
def __getitem__(self, idx):
if idx > self._len:
raise IndexError()
idx = self._len - idx
return int((self._val >> idx) & 1)
def __getslice__(self, a, b):
if b > self._len:
b = self._len
i = self._val >> (self._len - b)
l = b - a
mask = (1 << l) - 1
return BitVector(i & mask, length=l)
def __iter__(self):
"""Iterate from LSB to MSB"""
v = self._val
for i in xrange(self._len):
yield int(v & 1)
v >>= 1
def __str__(self):
r = ''
v = self._val
i = self._len
while i > 8:
o = ((v >> (i - 8)) & 0xFF)
r += chr(o)
i -= 8
if i > 0:
o = v & ((1 << i) - 1)
r += chr(o)
return r
def __int__(self):
return self._val
def __repr__(self):
l = list(self)
l.reverse()
return '<BitVector ' + ''.join(str(x) for x in l) + '>'
def __add__(self, i):
if isinstance(i, BitVector):
l = len(self) + len(i)
v = (int(self) << len(i)) + int(i)
return BitVector(v, l)
else:
raise ValueError("Can't extend with this type yet")
def bitstr(self):
bits = [str(x) for x in self]
bits.reverse()
return ''.join(bits)
def bin(i, bits=None):
"""Return the binary representation of i"""
return BitVector(i, bits).bitstr()
def unhex(s):
"""Decode a string as hex, stripping whitespace first"""
return [ord(i) for i in s.replace(' ', '').decode('hex')]
##
## Codecs
##
import codecs
from __init__ import BitVector
class Esab64Codec(codecs.Codec):
"""Little-endian version of base64."""
## This could be made nicer by better conforming to the codecs.Codec
## spec. For instance, raising the appropriate exceptions.
##
## Using BitVector makes the code very readable, but it is probably
## slow.
b64_chars = 'ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/'
def decode(self, input, errors='strict'):
r = []
for i in range(0, len(input), 4):
v = BitVector()
for c in input[i:i+4]:
if c in ('=', ' ', '\n'):
break
v += BitVector(self.b64_chars.index(c), 6)
# Normal base64 would start at the beginning
b = (v[10:12] + v[ 0: 6] +
v[14:18] + v[ 6:10] +
v[18:24] + v[12:14])
r.append(str(b))
return ''.join(r), len(input)
def encode(self, input, errors='strict'):
raise NotImplementedError()
class Esab64StreamWriter(Esab64Codec, codecs.StreamWriter):
pass
class Esab64StreamReader(Esab64Codec, codecs.StreamReader):
pass
def _registry(encoding):
if encoding == 'esab64':
c = Esab64Codec()
return (c.encode, c.decode,
Esab64StreamReader, Esab64StreamWriter)
codecs.register(_registry)