Graph function removed

No need for graph anymore. Output from IMU is already quite smooth. Work
on fixing issues by calibrating RATE PIDs soon.