updated joint sensor feedback

+ better distrubance rejection
+ better noise atten