First implementation of a Behavior Tree implemented in c++