Хм. Щас пришел на работу перепроверил, и действительно не те диагонали в расчет взял. Программа тут работает попроще . на картинке изобразил.