Added first diagonal method (not performant)
Removed debug message