Hierarchical models

TO DO: Model hierarchical systems (Pendulum with bar & controller with path planning)