Implement entrance checkpoint for dock target

[rwbot]

Since planner weighs goal distance over orientation more, this will allow the planner to aim a set distance in front of target as an intermediate goal where any orientation error can be aligned, and then trajectory just needs to go straight forward