Refactored. Added partial implementation for interpolation of position and rotation.