quaternion interpolation

Trying to debug Y-calculation:
- we need better quaternion interpolation (slerp.m !)
- current results are not good
- added some code comments and minor style changes