Algorithms for robot manipulators can be designed, simulated, and implemented with Model-Based Design using Simulink^® blocks in Robotics System Toolbox™. You can easily implement algorithms like Computed Torque Control, which can further be used to perform safe trajectory tracking control for human-robot collaboration.