Correction of errors and position computation. Now working Lets get to test it tomorrow.