Made Herocontroller

Made controller like the class diagramm, also added a testController for
testing the movements on the pc