Added functions to calibrate board, not there yet though