added matching template function but somewhere in the code it's slowing down the computer/herb. need to fix it
subscribed to real time velocity and it's really smooth