Added headers to all files
All tests now working (except for test_webcam_calib.m, but that's ok)