Matlab test script: manual gyro & accel calibration, AHRS filter tuning, fixed tip pos kinematics, fixed yaw angle HP filter, visualization, image saving, commenting.
New corrected penn_test2.m