LocalCoordinateMapper完成

内部パラメータの推定が不完全なのでそのうち続きを