Initial commit of all my custom matlab functions