[collada2eus_urdfmodel.cpp] print links in the order of link names

[Naoki-Hiraoka]

#250 (comment) に対応したPull Requestです。

これまで、collada2eusのソースコードに変更を加える度に、生成されるeusモデルのリンクの宣言順が変わってしまって、生成されるeusモデルに大きなdiffが発生してしまい、collada2eusに加えた変更が妥当かどうかの検証がしづらい、という問題が有りました。

考えられる原因は、次のとおりです。

collada2eusは、

jsk_model_tools/euscollada/src/collada2eus_urdfmodel.cpp

Lines 777 to 781 in 6749740

	#if URDFDOM_1_0_0_API
	for (map<LinkConstSharedPtr, Pose >::iterator it = m_link_coords.begin();
	#else
	for (map<boost::shared_ptr<const Link>, Pose >::iterator it = m_link_coords.begin();
	#endif

や

jsk_model_tools/euscollada/src/collada2eus_urdfmodel.cpp

Lines 1862 to 1866 in 6749740

	#if URDFDOM_1_0_0_API
	for(map <LinkConstSharedPtr, MapVisual >::iterator it = m_link_visual.begin();
	#else
	for(map <boost::shared_ptr<const Link>, MapVisual >::iterator it = m_link_visual.begin();
	#endif

で、linkのshared_ptrをキーとするmapにlinkが格納されていて、mapのイテレータを回したときにどのような順番になっているかによって、linkの宣言順番が決まっています。mapのイテレータの順番は、デフォルトだと恐らくlinkのアドレス順になるので、linkのメモリを確保するときにどのアドレスに確保されたかに依存すると思われます。そのため、collada2eusのソースコードに変更を加えると、変更した部分で行うメモリ確保・開放がlinkのアドレスに何らかの影響を与えて、linkの宣言順番が変化してしまっているのではないかと思います。

このPull Reqeustは、mapのイテレータを回したときに、リンク名のアルファベット順で回るように変更することで、この問題を解決するものです。