Update six_axis_comp_filter.c