Development of the control algorithm for a motorized needle insertion platform