diagonal matrix sum in python