debugged compensation, fixed ft_compensated to ft_gravity_compensated