Performance improvement

Improve performance by 5-20% depending on the function (more for smaller data sizes).
Various small updates and fixes.