Bresenham2d 算法 （matlab)

原理部分参考 布莱森汉姆算法原理介绍

matlab程序

clc;
clear;
close all;

%% 测试二维bresenham algorithm

%读取图像
ImpRgb = imread('map.png');
global Imp;
Imp = rgb2gray(ImpRgb);
%使得图像占满整个figure窗口
imshow(Imp,'border','tight','initialmagnification','fit');
%set(gcf,'position',[0,0,60,80]);
size(Imp,1)  %height
size(Imp,2)  %width
hold on;
start_pt = [1,10];
goal_pt = [620,460];
plot(start_pt(1,1),start_pt(1,2),'ro','MarkerSize',5,'MarkerFaceColor','r');
plot(goal_pt(1,1),goal_pt(1,2),'go','MarkerSize',5,'MarkerFaceColor','g');  %x,y取值 返回y,x
hold on;
%plot(start_pt,goal_pt);
hold on;
vPts = bresenham_2d(start_pt, goal_pt);  
plot(vPts(:,2), vPts(:,1),'b*');
%plot (pt(1,1), pt(1,2), 'r*');  %x,y
hold on;