Matriz diagonal normal e invertida 4x4

Te invito a que teclees el código para que te des cuente de como funciona, el solo copiar y pegar puede que te asegure que el trabajo este listo,
pero no que tus conocimientos lo estén, SUERTE!!!