adds controller and driver code
Merge pull request #3 from opleban/Ori

adds controller and driver code