Какой-то квадратовый у тебя алгоритм (в смысле квадраты рисует

)
Я с алгоритмом не знаком, поетому копипастерством заниматься не буду, но в Википедии полностью рабочий пример приведен - если не лень то можно посмотреть - работает отлично, и не зависит от формата изображения - уже проверил)