Added tangential direction and smoothen X & Y direction using weihua's height control method.
Need to remove inner tangential direction and just to remain as outer tangential.

Next task:
1. More test with 8-Inch for reliability test;
2. Test program on 10-inch quad.
3. Full Test.