Added most things EXCEPT the control algorithm for sail sontrol now!