算法 & 数据结构——A*寻路

A*是一种很常见的游戏寻路算法。

长久以来,我一直觉得A*是一种高大上的算法,因为听很多人说起此算法,然而,江湖一张纸,戳穿不值一毛钱,思路其实很简单通过估值函数决定下一步走向

估值函数

  • 决定整个算法的效率,以及准确率。
  • 可以根据实际需求,使用不同的估值函数。

实现

#pragma once

#include "base.h"
#include "math.h"
#include "priority_queue.h"

class AStar {
public:
    struct Box {
        MATH Vec2 parent;
        MATH Vec2 self;
        int G, H;
        int F() const
        {
            return G + H;
        }

        Box()
        { }

        explicit Box(const MATH Vec2 & pt1, const MATH Vec2 & pt2)
            : parent(pt1)
            , self(pt2)
        { }

        explicit Box(const MATH Vec2 & pt1, const MATH Vec2 & pt2, int g, int h)
            : parent(pt1)
            , self(pt2)
            , G(g)
            , H(h)
        { }

        bool operator==(const MATH Vec2 & point) const
        {
            return MATH equal(self, point);
        }

        bool operator<(const Box & other) const
        {
            return F() > other.F();
        }
    };

    using NextFunc = STD function<void(const MATH Vec2 &)>;
    using TestFunc = STD function<bool(const MATH Vec2 &)>;
public:
    AStar()
    { }

    ~AStar()
    { }

    bool IsFinish()
    {
        return _openList.empty() || MATH equal(_end, _openList.top().self);
    }

    const MATH Vec2 & GetQueryBeg() const
    {
        return _beg;
    }

    const MATH Vec2 & GetQueryEnd() const
    {
        return _end;
    }

    void SetQueryPoint(const MATH Vec2 & beg, const MATH Vec2 & end)
    {
        _beg = beg;
        _end = end;
        _closeList.clear();
        _openList = priority_queue<Box>();
        _openList.emplace(beg, beg, 0, 0);
    }

    bool GetQueryPath(STD vector<MATH Vec2> & path)
    {
        if (!MATH equal(_end, _closeList.back().self))
        {
            return false;
        }
        auto parent = _closeList.back().self;
        for (; !_closeList.empty(); _closeList.pop_back())
        {
            if (MATH equal(parent, _closeList.back().self))
            {
                path.push_back(_closeList.back().self);
                parent = _closeList.back().parent;
            }
        }
        return true;
    }

    void SetTestFunc(const TestFunc & func)
    {
        _testFunc = func;
    }

    void SetNextFunc(const NextFunc & func)
    {
        _nextFunc = func;
    }

    bool QueryNext()
    {
        static const MATH Vec2 s_offset[] = {
            { 0, -1 },{ 1, 0 },{ 0, 1 },{ -1, 0 },          //  上,右,下,左。
            //{ 1, -1 },{ 1, 1 },{ -1, 1 },{ -1,-1 },           //  右上,右下,左下,左上。
        };
        
        if (!MATH equal(_end, _openList.top().self))
        {
            auto top = _openList.top();
            _closeList.push_back(top);
            _nextFunc(top.self);
            _openList.pop();
            for (auto &offset : s_offset)
            {
                CheckPoint(top, MATH add(top.self, offset));
            }
        }

        if (!_openList.empty() && MATH equal(_end, _openList.top().self))
        {
            _closeList.push_back(_openList.top());
            _nextFunc(_openList.top().self);
        }

        return IsFinish();
    }

private:
    void CheckPoint(const Box & from, const MATH Vec2 & to)
    {
        if (Test(to))
        {
            _openList.emplace(from.self, to, from.G + 1, Distance(to));
        }
    }

    int Distance(const MATH Vec2 & point)
    {
        return (int)(STD abs(point.x - _end.x) + STD abs(point.y - _end.y));
    }

    bool Test(const MATH Vec2 & point)
    {
        return _testFunc(point)
            && STD find(_openList.begin(), _openList.end(), point) == _openList.end()
            && STD find(_closeList.begin(), _closeList.end(), point) == _closeList.end();
    }

private:
    MATH Vec2 _beg;
    MATH Vec2 _end;
    NextFunc _nextFunc;
    TestFunc _testFunc;
    priority_queue<Box> _openList;
    STD vector<Box> _closeList;

private:
    AStar(const AStar &) = delete;
    AStar(AStar &&) = delete;
    AStar operator=(const AStar &) = delete;
    AStar operator=(AStar &&) = delete;

};

效果

A*寻路

DEMO下载

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 204,732评论 6 478
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 87,496评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 151,264评论 0 338
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,807评论 1 277
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,806评论 5 368
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,675评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 38,029评论 3 399
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,683评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 41,704评论 1 299
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,666评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,773评论 1 332
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,413评论 4 321
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 39,016评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,978评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,204评论 1 260
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 45,083评论 2 350
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,503评论 2 343

推荐阅读更多精彩内容