Removed unused callback from System.cc
Added a quaternion class and modified SwarmLab to output quaternions on serial.