Stabilization implemented and seems to work fine. Also added checks to make sure that PTU didn't hit its rotation limits while calibrating.