Well, I think you need a simple proportional controller..
for example,
loop:
//first axis
do
start by increasing the first angle..
if the signal gets stronger you continue to increase until the max signal
if the signal gets weaker you reverse the increment..
loop until max signal
decrease one increment to get back to max signal
//second axis
do
start by increasing the first angle..
if the signal gets stronger you continue to increase until the max signal
if the signal gets weaker you reverse the increment..
loop until max signal
decrease one increment to get back to max signal
//save data...
endloop
... you can save positions and signal strengh to and sd card, or eeprom, or even send it to a computer trough usb
... this was a tracking system...
now if you want to get something like a signal strenght plot, just scan all possible positions and save the respective signal strenght with the angle positions... you can scan it in a similar way as you go trough a algebra matrix...