Simplest possible steer function
initial control::FMT work
Working on control::FMT::solve()