Algoritmus na 4-bodovou kalibraci 2D mapy?

[RayeR]

Zdar,
neresil tu nekdo nahodou problem kalibrace 2D mapy?
Potreboval bych napsat fci, ktere dam 4 2D souradnice bodu na mape (v pixelech) a 4 2D souradnice (v nejakem systemu, treba wgs), a nasledne mi tato fce podle zadaneho bodu [x,y] vrati prepoctene souradnice [x',y']v pixelech (a naopak, inverzni fce).
Mam napsanou jednochou verzi pro 2-bodovou kalibraci, ktera ale predpoklada ze osy obou sour. systemu sou rovnobezne, zistil sem vsak ze mapa je asi o 0.5stupne pootocena...

BTW mozna by stacily jen 3 body, ale asi by musely tvorit pravouhly trojuhelnik..

EDIT:
Aby to bylo jasny, tak tady este nacrtek (znam x1-4,y1-4 a jejich obrazy, hledam funkci f)

Idealni by byl zdrojak v C ale postaci nejaky odkaz kde se tohle resi, zatim sem nic rozumnyho nenasel.