Fixes hardcoded constant
Initialize whisker value
Starting to create base to test sensors