$$\mathbf{a}_c=\mathbf{K}_x(\mathbf{x}_ref-\mathbf{x})+\mathbf{K}_v(\mathbf{v}_ref-\mathbf{v})+\mathbf{a}_{ref}$$