Update vibrate.m

Add calculation of displacement