blob: 0a222add1c7aca893fe7eded9d4ca99c28754d86 [file] [log] [blame]
#
# Copyright 2016 the original author or authors.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.
#
"""
A module that can send and receive raw ethernet frames on a set of interfaces
and it can manage a set of vlan interfaces on top of existing
interfaces. Due to reliance on raw sockets, this module requires
root access. Also, raw sockets are hard to deal with in Twisted (not
directly supported) we need to run the receiver select loop on a dedicated
thread.
"""
import os
import socket
import struct
from pcapy import BPFProgram
from threading import Thread, Condition
import fcntl
import select
import structlog
import sys
from scapy.data import ETH_P_ALL
from twisted.internet import reactor
from zope.interface import implementer
from voltha.registry import IComponent
if sys.platform.startswith('linux'):
from common.frameio.third_party.oftest import afpacket, netutils
elif sys.platform == 'darwin':
from scapy.arch import pcapdnet, BIOCIMMEDIATE
log = structlog.get_logger()
def hexify(buffer):
"""
Return a hexadecimal string encoding of input buffer
"""
return ' '.join('%02x' % ord(c) for c in buffer)
class _SelectWakerDescriptor(object):
"""
A descriptor that can be mixed into a select loop to wake it up.
"""
def __init__(self):
self.pipe_read, self.pipe_write = os.pipe()
fcntl.fcntl(self.pipe_write, fcntl.F_SETFL, os.O_NONBLOCK)
def __del__(self):
os.close(self.pipe_read)
os.close(self.pipe_write)
def fileno(self):
return self.pipe_read
def wait(self):
os.read(self.pipe_read, 1)
def notify(self):
"""Trigger a select loop"""
os.write(self.pipe_write, '\x00')
class BpfProgramFilter(object):
"""
Convenience packet filter based on the well-tried Berkeley Packet Filter,
used by many well known open source tools such as pcap and tcpdump.
"""
def __init__(self, program_string):
"""
Create a filter using the BPF command syntax. To learn more,
consult 'man pcap-filter'.
:param program_string: The textual definition of the filter. Examples:
'vlan 1000'
'vlan 1000 and ip src host 10.10.10.10'
"""
self.bpf = BPFProgram(program_string)
def __call__(self, frame):
"""
Return 1 if frame passes filter.
:param frame: Raw frame provided as Python string
:return: 1 if frame satisfies filter, 0 otherwise.
"""
return self.bpf.filter(frame)
class FrameIOPort(object):
"""
Represents a network interface which we can send/receive raw
Ethernet frames.
"""
RCV_SIZE_DEFAULT = 4096
ETH_P_ALL = 0x03
RCV_TIMEOUT = 10000
def __init__(self, iface_name, callback, filter=None):
self.iface_name = iface_name
self.callback = callback
self.filter = filter
self.socket = self.open_socket(self.iface_name)
log.debug('socket-opened', fn=self.fileno(), iface=iface_name)
self.received = 0
self.discarded = 0
def open_sockets(self, iface_name):
raise NotImplementedError('to be implemented by derived class')
def rcv_frame(self):
raise NotImplementedError('to be implemented by derived class')
def __del__(self):
if self.socket:
self.socket.close()
self.socket = None
log.debug('socket-closed', iface=self.iface_name)
def fileno(self):
return self.socket.fileno()
def _dispatch(self, frame):
log.debug('calling-publisher', frame=hexify(frame))
self.callback(self, frame)
def recv(self):
"""Called on the select thread when a packet arrives"""
try:
frame = self.rcv_frame()
except RuntimeError, e:
# we observed this happens sometimes right after the socket was
# attached to a newly created veth interface. So we log it, but
# allow to continue.
log.warn('afpacket-recv-error', code=-1)
return
log.debug('frame-received', iface=self.iface_name, len=len(frame),
hex=hexify(frame))
self.received +=1
if self.filter is None or self.filter(frame):
log.debug('frame-dispatched')
reactor.callFromThread(self._dispatch, frame)
else:
self.discarded += 1
log.debug('frame-discarded')
def send(self, frame):
log.debug('sending', len=len(frame), iface=self.iface_name)
sent_bytes = self.socket.send(frame)
if sent_bytes != len(frame):
log.error('send-error', iface=self.iface_name,
wanted_to_send=len(frame), actually_sent=sent_bytes)
return sent_bytes
def up(self):
os.system('ip link set {} up'.format(self.iface_name))
return self
def down(self):
os.system('ip link set {} down'.format(self.iface_name))
return self
def statistics(self):
return self.received, self.discarded
class LinuxFrameIOPort(FrameIOPort):
def open_socket(self, iface_name):
s = socket.socket(socket.AF_PACKET, socket.SOCK_RAW, 0)
afpacket.enable_auxdata(s)
s.bind((self.iface_name, self.ETH_P_ALL))
netutils.set_promisc(s, iface_name)
s.settimeout(self.RCV_TIMEOUT)
return s
def rcv_frame(self):
return afpacket.recv(self.socket, self.RCV_SIZE_DEFAULT)
class DarwinFrameIOPort(FrameIOPort):
def open_socket(self, iface_name):
s = pcapdnet.open_pcap(iface_name, 1600, 1, 100)
try:
fcntl.ioctl(s.fileno(), BIOCIMMEDIATE, struct.pack("I",1))
except:
pass
return s
def rcv_frame(self):
pkt = self.socket.next()
if pkt is not None:
ts, pkt = pkt
return pkt
if sys.platform == 'darwin':
_FrameIOPort = DarwinFrameIOPort
elif sys.platform.startswith('linux'):
_FrameIOPort = LinuxFrameIOPort
else:
raise Exception('Unsupported platform {}'.format(sys.platform))
sys.exit(1)
@implementer(IComponent)
class FrameIOManager(Thread):
"""
Packet/Frame IO manager that can be used to send/receive raw frames
on a set of network interfaces.
"""
def __init__(self):
super(FrameIOManager, self).__init__()
self.ports = {} # iface_name -> ActiveFrameReceiver
self.queue = {} # iface_name -> TODO
self.cvar = Condition()
self.waker = _SelectWakerDescriptor()
self.stopped = False
self.ports_changed = False
# ~~~~~~~~~~~ exposed methods callable from main thread ~~~~~~~~~~~~~~~~~~~
def start(self):
"""
Start the IO manager and its select loop thread
"""
log.debug('starting')
super(FrameIOManager, self).start()
log.info('started')
return self
def stop(self):
"""
Stop the IO manager and its thread with the select loop
"""
log.debug('stopping')
self.stopped = True
self.waker.notify()
self.join()
del self.ports
log.info('stopped')
def list_interfaces(self):
"""
Return list of interfaces listened on
:return: List of FrameIOPort objects
"""
return self.ports
def add_interface(self, iface_name, callback, filter=None):
"""
Add a new interface and start receiving on it.
:param iface_name: Name of the interface. Must be an existing Unix
interface (eth0, en0, etc.)
:param callback: Called on each received frame;
signature: def callback(port, frame) where port is the FrameIOPort
instance at which the frame was received, frame is the actual frame
received (as binay string)
:param filter: An optional filter (predicate), with signature:
def filter(frame). If provided, only frames for which filter evaluates
to True will be forwarded to callback.
:return: FrmaeIOPort instance.
"""
"""Add a new interface"""
assert iface_name not in self.ports
port = _FrameIOPort(iface_name, callback, filter)
self.ports[iface_name] = port
# need to exit select loop to reconstruct select fd lists
self.ports_changed = True
self.waker.notify()
return port
def del_interface(self, iface_name):
"""
Stop and remove named interface
:param iface_name: Name of previoysly registered interface
:return: None
"""
assert iface_name in self.ports
port = self.ports[iface_name]
del self.ports[iface_name]
# need to exit select loop to reconstruct select fd lists
self.ports_changed = True
self.waker.notify()
def send(self, iface_name, frame):
"""
Send frame on given interface
:param iface_name: Name of previously registered interface
:param frame: frame as string
:return: number of bytes sent
"""
return self.ports[iface_name].send(frame)
# ~~~~~~~~~~~~~ Thread methods (running on non-main thread ~~~~~~~~~~~~~~~~
def run(self):
"""
Called on the alien thread, this is the core multi-port receive loop
"""
log.debug('select-loop-started')
# outer loop constructs sockets list for select
while not self.stopped:
sockets = [self.waker] + self.ports.values()
self.ports_changed = False
empty = []
# inner select loop
while not self.stopped:
try:
_in, _out, _err = select.select(sockets, empty, empty, 1)
except Exception, e:
log.exception('frame-io-select-error', e=e)
break
with self.cvar:
for port in _in:
if port is self.waker:
self.waker.wait()
continue
else:
port.recv()
self.cvar.notify_all()
if self.ports_changed:
break # break inner loop so we reconstruct sockets list
log.debug('select-loop-exited')