Added code for whisker sensing robot