FindOriginNode.go

func FindOriginNode(listNodes bool) string {
	originDist := float64(100 * 100)
	for _, node := range Nodes {
		sqd, _ := node.XCoord.Pow(decimal.NewFromInt(2)).Add(node.YCoord.Pow(decimal.NewFromInt(2))).Float64()
		d := math.Sqrt(sqd)
		if d < originDist {
			originDist = d
			OriginNode = node
		}
	}
	var sbldr = strings.Builder{}
	sbldr.WriteString("\nClosest node to origin is " + OriginNode.String())
	if listNodes {
		sbldr.WriteString("\nNodes: ")
		for _, node := range Nodes {
			sbldr.WriteString("\n\t" + node.String())
		}
	}
	NextNode = OriginNode
	return sbldr.String()
}