fix aligned vec type and add matrix funcs

fix aligned vec type and add matrix funcs #240