Rename unit matrix to identity matrix (as used in English).
More simplifications, comments, renamed unit matrixes to identity matrixes (English).
Added doxygen style documentation for the main procedure function.
Replaced load variants inside a switch with a short table.