Possible solution:
‘Forward planning’ does
work
Class solution for beam
direction and segment
shape
Simple cost function
12-18 segments overall
Simple plan verification