Testing and finalizing calibration code
Added debug file
Merge branch 'master' of https://github.com/UCSD-E4E/BBB_SACP

Updating debug and calibration code.