ソフトの修正開始

新しいハード構成に合わせてサーボ周りのプログラムの修正を開始しました。