Improve shot finding and evaluating algorithm

[rivques]

Currently the shot finder assumes that the target and the robot are at the same height and doesn't take getting over the rim into account. It also naively evaluates shot probability.