diff --git a/src/navigate.cpp b/src/navigate.cpp
index d88d780..487a166 100644
--- a/src/navigate.cpp
+++ b/src/navigate.cpp
@@ -850,7 +850,7 @@ bool Bot::updateNavigation () {
                if (feet.z > feet.z) {
                   feet = pev->origin + pev->maxs;
                }
-               feet = { pev->origin.x, pev->origin.y,  feet.z };
+               feet = { pev->origin.x, pev->origin.y,  pev->origin.z };
 
                // calculate like we do with grenades
                auto velocity = calcThrow (feet, node);
diff --git a/src/planner.cpp b/src/planner.cpp
index ec2cbd2..93bcc6f 100644
--- a/src/planner.cpp
+++ b/src/planner.cpp
@@ -176,7 +176,7 @@ bool AStarAlgo::cantSkipNode (const int a, const int b) {
    const auto &ag = graph[a];
    const auto &bg = graph[b];
 
-   const bool hasZeroRadius = cr::fzero (ag.radius) || cr::fzero (ag.radius);
+   const bool hasZeroRadius = cr::fzero (ag.radius) || cr::fzero (bg.radius);
 
    if (hasZeroRadius) {
       return true;