Sq1 servo and sq2 servo

From MCEWiki

Bug list

  • sq1servo and sq2servo may calculate out-of-range feedback values