まぁとにかく、
iOS上でサーボを動かすところまでは出来ました。

パルスとかも問題ですが、

角度のフィードバックが欲しいところですよ。

運動計算も書いてやってみます。

http://i.imgur.com/itmXtqn.jpg