Print goal selection debug info to log

[alxhoff]

During goal selection, print, for each goal, the resulting value, ie. the value after goal value is subtracted and after normalization. As well as logging the selected goal so we can sanity check these values are correct.