SGPモデルを実装した

- SGPで位置と速度が計算できるようになった
- 全象限でarc tanを計算可能な、actan関数を追加した