How to build a diagonal matrix in python