Dynamically Consistent Trajectory Planners And Human-Aware Controllers For Human-Centered Robots