The lack of physiological motion compensation is a major problem in robotic-assisted cardiac surgery. Since the heart is beating while the surgeon carried out the procedure, dexterity of the surgeon’s and precision are compromised. Due to the operative space and the visibility of the surgical field are reduced, the most practical solution is the use of computer vision techniques. The lack of efficiency and robustness of the existing proposals make physiological motion compensation to be considered an open problem. In this work a novel solution to solve this problem based on the minimization of an energy functional is presented. It is described in the three-dimensional space using the l1-regularized optimization class in which cubic b-splines are used to represent the changes produced on the heart surface. Moreover, the logarithmic barrier function is applied to create an approximation of the total energy in order to avoid its non-differentiability. According to the results, this proposal is able to deal with complex deformations, requires a short computational time and gives a small error.