adding wrench-based friction compensation
Adding exp filtering