Add penalty MPC constraint support

This commit is contained in:
shenw
2026-06-22 23:25:35 +08:00
parent 81ba21af55
commit 473d97891c
6 changed files with 484 additions and 0 deletions
+3
View File
@@ -761,6 +761,9 @@ contains
call boundary_apply_robin_forces(current_time, ierr)
if (ierr .ne. FEM_SUCCESS) return
call boundary_apply_mpc_forces(ierr)
if (ierr .ne. FEM_SUCCESS) return
do dof = 1, ndof
rhs = fext(dof) + fsph(dof) + fcontact(dof) - fint(dof)
a(dof) = rhs / mass_diag(dof)