add player package with key client-side player functionality, update protocol codecs, and refactor metadata definitions and slot usage
This commit is contained in:
188
pkg/game/player/pathfinding.go
Normal file
188
pkg/game/player/pathfinding.go
Normal file
@ -0,0 +1,188 @@
|
||||
package player
|
||||
|
||||
import (
|
||||
"container/heap"
|
||||
"math"
|
||||
|
||||
"git.konjactw.dev/patyhank/minego/pkg/bot"
|
||||
"git.konjactw.dev/patyhank/minego/pkg/protocol"
|
||||
"github.com/Tnze/go-mc/level/block"
|
||||
"github.com/go-gl/mathgl/mgl64"
|
||||
)
|
||||
|
||||
// Node 表示 A* 演算法中的節點
|
||||
type Node struct {
|
||||
Position protocol.Position
|
||||
G float64 // 從起點到當前節點的實際距離
|
||||
H float64 // 從當前節點到終點的啟發式距離
|
||||
F float64 // G + H
|
||||
Parent *Node
|
||||
Index int // heap 索引
|
||||
}
|
||||
|
||||
// NodeHeap 實現 heap.Interface 用於優先佇列
|
||||
type NodeHeap []*Node
|
||||
|
||||
func (h NodeHeap) Len() int { return len(h) }
|
||||
func (h NodeHeap) Less(i, j int) bool { return h[i].F < h[j].F }
|
||||
func (h NodeHeap) Swap(i, j int) {
|
||||
h[i], h[j] = h[j], h[i]
|
||||
h[i].Index = i
|
||||
h[j].Index = j
|
||||
}
|
||||
|
||||
func (h *NodeHeap) Push(x interface{}) {
|
||||
n := len(*h)
|
||||
node := x.(*Node)
|
||||
node.Index = n
|
||||
*h = append(*h, node)
|
||||
}
|
||||
|
||||
func (h *NodeHeap) Pop() interface{} {
|
||||
old := *h
|
||||
n := len(old)
|
||||
node := old[n-1]
|
||||
node.Index = -1
|
||||
*h = old[0 : n-1]
|
||||
return node
|
||||
}
|
||||
|
||||
// AStar 使用 A* 演算法尋找路徑
|
||||
func AStar(world bot.World, start, goal mgl64.Vec3) ([]mgl64.Vec3, error) {
|
||||
startPos := protocol.Position{int32(start.X()), int32(start.Y()), int32(start.Z())}
|
||||
goalPos := protocol.Position{int32(goal.X()), int32(goal.Y()), int32(goal.Z())}
|
||||
|
||||
openSet := &NodeHeap{}
|
||||
heap.Init(openSet)
|
||||
|
||||
closedSet := make(map[protocol.Position]bool)
|
||||
allNodes := make(map[protocol.Position]*Node)
|
||||
|
||||
startNode := &Node{
|
||||
Position: startPos,
|
||||
G: 0,
|
||||
H: heuristic(startPos, goalPos),
|
||||
}
|
||||
startNode.F = startNode.G + startNode.H
|
||||
|
||||
heap.Push(openSet, startNode)
|
||||
allNodes[startPos] = startNode
|
||||
|
||||
for openSet.Len() > 0 {
|
||||
current := heap.Pop(openSet).(*Node)
|
||||
|
||||
if current.Position == goalPos {
|
||||
return reconstructPath(current), nil
|
||||
}
|
||||
|
||||
closedSet[current.Position] = true
|
||||
|
||||
// 檢查相鄰節點
|
||||
for _, neighbor := range getNeighbors(current.Position) {
|
||||
if closedSet[neighbor] {
|
||||
continue
|
||||
}
|
||||
|
||||
// 檢查是否可通行
|
||||
if !isWalkable(world, neighbor) {
|
||||
continue
|
||||
}
|
||||
|
||||
tentativeG := current.G + distance(current.Position, neighbor)
|
||||
|
||||
neighborNode, exists := allNodes[neighbor]
|
||||
if !exists {
|
||||
neighborNode = &Node{
|
||||
Position: neighbor,
|
||||
G: math.Inf(1),
|
||||
H: heuristic(neighbor, goalPos),
|
||||
}
|
||||
allNodes[neighbor] = neighborNode
|
||||
}
|
||||
|
||||
if tentativeG < neighborNode.G {
|
||||
neighborNode.Parent = current
|
||||
neighborNode.G = tentativeG
|
||||
neighborNode.F = neighborNode.G + neighborNode.H
|
||||
|
||||
if neighborNode.Index == -1 {
|
||||
heap.Push(openSet, neighborNode)
|
||||
} else {
|
||||
heap.Fix(openSet, neighborNode.Index)
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return nil, nil // 找不到路徑
|
||||
}
|
||||
|
||||
// heuristic 計算啟發式距離(曼哈頓距離)
|
||||
func heuristic(a, b protocol.Position) float64 {
|
||||
return math.Abs(float64(a[0]-b[0])) + math.Abs(float64(a[1]-b[1])) + math.Abs(float64(a[2]-b[2]))
|
||||
}
|
||||
|
||||
// distance 計算兩點間的實際距離
|
||||
func distance(a, b protocol.Position) float64 {
|
||||
dx := float64(a[0] - b[0])
|
||||
dy := float64(a[1] - b[1])
|
||||
dz := float64(a[2] - b[2])
|
||||
return math.Sqrt(dx*dx + dy*dy + dz*dz)
|
||||
}
|
||||
|
||||
// getNeighbors 獲取相鄰節點
|
||||
func getNeighbors(pos protocol.Position) []protocol.Position {
|
||||
neighbors := []protocol.Position{
|
||||
{pos[0] + 1, pos[1], pos[2]}, // 東
|
||||
{pos[0] - 1, pos[1], pos[2]}, // 西
|
||||
{pos[0], pos[1], pos[2] + 1}, // 南
|
||||
{pos[0], pos[1], pos[2] - 1}, // 北
|
||||
{pos[0], pos[1] + 1, pos[2]}, // 上
|
||||
{pos[0], pos[1] - 1, pos[2]}, // 下
|
||||
}
|
||||
return neighbors
|
||||
}
|
||||
|
||||
// isWalkable 檢查位置是否可通行
|
||||
func isWalkable(world bot.World, pos protocol.Position) bool {
|
||||
// 檢查腳部位置
|
||||
footBlock, err := world.GetBlock(pos)
|
||||
if err != nil {
|
||||
return false
|
||||
}
|
||||
|
||||
// 檢查頭部位置
|
||||
headPos := protocol.Position{pos[0], pos[1] + 1, pos[2]}
|
||||
headBlock, err := world.GetBlock(headPos)
|
||||
if err != nil {
|
||||
return false
|
||||
}
|
||||
|
||||
// 檢查地面位置
|
||||
groundPos := protocol.Position{pos[0], pos[1] - 1, pos[2]}
|
||||
groundBlock, err := world.GetBlock(groundPos)
|
||||
if err != nil {
|
||||
return false
|
||||
}
|
||||
|
||||
// 腳部和頭部必須是空氣,地面必須是固體方塊
|
||||
return footBlock == block.Air{} && headBlock == block.Air{} && groundBlock != block.Air{}
|
||||
}
|
||||
|
||||
// reconstructPath 重建路徑
|
||||
func reconstructPath(node *Node) []mgl64.Vec3 {
|
||||
var path []mgl64.Vec3
|
||||
current := node
|
||||
|
||||
for current != nil {
|
||||
pos := mgl64.Vec3{
|
||||
float64(current.Position[0]),
|
||||
float64(current.Position[1]),
|
||||
float64(current.Position[2]),
|
||||
}
|
||||
path = append([]mgl64.Vec3{pos}, path...)
|
||||
current = current.Parent
|
||||
}
|
||||
|
||||
return path
|
||||
}
|
Reference in New Issue
Block a user