added dual lop to do things together
add coordinateframe.cpp
added correspondance, result not bad