Basic behaviour tree elements mostly implemented.
Cleaned up header files.