Thanks for your reply, I understand that I need integration to get the change in position. My problem is that my programming skill is really bad... 
I have the firmware given in the tutorial, but I don't know how should I write the code based on the firmware to achieve it. Could you pls kindly help me on this?
Many thanks!