Works for 1 pepper.
It works! Pretying up.
Prettified the code. Will test in Matlab.
Now runs in matlab
renamed the trilat directory to gt.