controller and driver code is updated
Merge pull request #6 from opleban/Ori

controller and driver code is updated