VibratorHW: formula fixes

Invert returned values properly