On Designing Optimal Trajectories for Servo-Actuated Mechanisms: Detailed Virtual Prototyping and Experimental Evaluation