Added more matlab functions implemented in C