look into planner point_at
proof of concept for speeding up gradient works
proof of concept done in c++ now
updated transform. and first box tests successful