Added roll(), pitch(), heave() and calibrate() functions.

Changes to the .cpp to match the .h file: roll(), pitch(), heave, calibrate()