腕の位置決め苦戦中

それっぽい値は出ているけど、基準軸がずれているような符号がおかしいような帰ってくる値がおかしい。