diff --git a/.github/workflows/TagBot.yml b/.github/workflows/TagBot.yml
new file mode 100644
index 000000000..623860f70
--- /dev/null
+++ b/.github/workflows/TagBot.yml
@@ -0,0 +1,15 @@
+name: TagBot
+on:
+  issue_comment:
+    types:
+      - created
+  workflow_dispatch:
+jobs:
+  TagBot:
+    if: github.event_name == 'workflow_dispatch' || github.actor == 'JuliaTagBot'
+    runs-on: ubuntu-latest
+    steps:
+      - uses: JuliaRegistries/TagBot@v1
+        with:
+          token: ${{ secrets.GITHUB_TOKEN }}
+          ssh: ${{ secrets.DOCUMENTER_KEY }}
\ No newline at end of file
diff --git a/.github/workflows/juliaci.yml b/.github/workflows/juliaci.yml
index 459c3f56e..165a4724e 100644
--- a/.github/workflows/juliaci.yml
+++ b/.github/workflows/juliaci.yml
@@ -15,9 +15,9 @@ jobs:
   julia-ci:
     uses: franckgaga/testitem-workflow/.github/workflows/juliaci.yml@patch-1
     with:
-      memory-threshold: 0.9
       include-windows-x86: false
       include-macos-x64: false
+      allow-failure: "*:macos-aarch64"
     permissions: write-all
     secrets:
       codecov_token: ${{ secrets.CODECOV_TOKEN }}
\ No newline at end of file
diff --git a/Project.toml b/Project.toml
index fdb6f89f5..ea7e74a04 100644
--- a/Project.toml
+++ b/Project.toml
@@ -1,6 +1,6 @@
 name = "ModelPredictiveControl"
 uuid = "61f9bdb8-6ae4-484a-811f-bbf86720c31c"
-version = "2.16.0"
+version = "2.16.1"
 authors = ["Francis Gagnon"]
 
 [deps]
diff --git a/docs/src/manual/nonlinmpc2.md b/docs/src/manual/nonlinmpc2.md
index 031eb7caf..4d3b906c0 100644
--- a/docs/src/manual/nonlinmpc2.md
+++ b/docs/src/manual/nonlinmpc2.md
@@ -218,7 +218,6 @@ function simDAE(plant, N; x_0)
     x, d = x_0, [10.0]
     for i=1:N
         u     = i ≤ (1N÷4) ? [10.0]  : [11.0]
-        d     = i ≤ (2N÷4) ? [10.0]  : [12.0]
         c_Ain = i ≤ (3N÷4) ? c_Ain_0 : (c_Ain_0 - 0.01)
         plant.p[1] = c_Ain
         y = plant(d)
diff --git a/src/estimator/mhe/transcription.jl b/src/estimator/mhe/transcription.jl
index ee5f8b285..d18d9b39a 100644
--- a/src/estimator/mhe/transcription.jl
+++ b/src/estimator/mhe/transcription.jl
@@ -1517,18 +1517,22 @@ function predict_mhe!(
     i_d0arr = estim.direct ? 0 : nd # the first nd elements in D0 are useless if p=1
     x̂0 = @views x̂0arr[1:nx̂]
     for j=1:Nk
-        u0      = @views  estim.U0[(1+nu*(j-1)):(nu*j)]
-        d0      = @views  estim.D0[(1+nd*(j-1) + i_d0arr):(nd*j + i_d0arr)]
-        ŵ       = @views         Ŵ[(1+nŵ*(j-1)):(nŵ*j)]
-        k̄       = @views         K̄[(1+nk̄*(j-1)):(nk̄*j)]
-        û0      = @views         Û0[(1+nu*(j-1)):(nu*j)]
-        ûi      = @views Ûi[(1 + nu*(j-1)):(nu*j)]
-        di      = @views Di[(1 + nd*(j-1)):(nd*j)]
-        x̂0next  = @views         X̂0[(1+nx̂*(j-1)):(nx̂*j)]
-        d0next = @views (j < Nk) ? estim.D0[(1+nd*j + i_d0arr):(nd*(j+1) + i_d0arr)] : d0
+        u0     = @views  estim.U0[(1+nu*(j-1)):(nu*j)]
+        d0     = @views  estim.D0[(1+nd*(j-1) + i_d0arr):(nd*j + i_d0arr)]
+        ŵ      = @views         Ŵ[(1+nŵ*(j-1)):(nŵ*j)]
+        k̄      = @views         K̄[(1+nk̄*(j-1)):(nk̄*j)]
+        û0     = @views         Û0[(1+nu*(j-1)):(nu*j)]
+        ûi     = @views Ûi[(1 + nu*(j-1)):(nu*j)]
+        di     = @views Di[(1 + nd*(j-1)):(nd*j)]
+        x̂0next = @views         X̂0[(1+nx̂*(j-1)):(nx̂*j)]
+        if estim.direct || j < Nk # d0(k+1) is never needed if estim.direct
+            d0next = @views estim.D0[(1+nd*j + i_d0arr):(nd*(j+1) + i_d0arr)]
+        else # special case, d0(k+1)≈d0(k), since d0(k+1) is not available at time k:
+            d0next = d0
+        end
         if h > 0 && j < Nk
-            u0next = estim.U0[(1+nu*j):(nu*(j+1))]
-        else
+            u0next = @views estim.U0[(1+nu*j):(nu*(j+1))]
+        else # special case, û0(k+p)≈û0(k+p-1), since û0(k+p) is not available at time k:
             u0next = u0
         end
         û0next = @views j < Nk ? Û0[(1+nu*j):(nu*(j+1))] : Û0[1:nu]
diff --git a/test/2_test_state_estim.jl b/test/2_test_state_estim.jl
index 74f17b290..c24efde7c 100644
--- a/test/2_test_state_estim.jl
+++ b/test/2_test_state_estim.jl
@@ -1379,10 +1379,14 @@ end
     model = NonLinModel(f!, h!, 100.0, 1, 1, 1, 1; p)
     transcription = SingleShooting(1)
     mhe_foh = MovingHorizonEstimator(model; He=3, transcription)
-    preparestate!(mhe_foh, [0.0], [0.0])
-    x̂ = updatestate!(mhe_foh, [1.0], [0.0], [0.0])
-    info = getinfo(mhe_foh)
     @test mhe_foh.transcription.h == 1
+    for i in 1:50
+        preparestate!(mhe_foh, [1.5], [0.0])
+        updatestate!(mhe_foh, [0.0], [1.5], [0.0])
+    end
+    x̂ = preparestate!(mhe_foh, [1.5], [0.0])
+    @test mhe_foh([0.0]) ≈ [1.5]
+    info = getinfo(mhe_foh)
     @test info[:x̂] ≈ x̂
 end