Make setPoint method much simpler.
Merge pull request #1 from BabkinNick/master

Make setPoint method much simpler.