added sqrt-with-sgn
changed argument of main2 from optional to key
changed the method to calculate feature value, use sqrt-with-sgn, add fv when falling down or floating
publish add force topic only when force has changed.