Safe Planning And Control Of Autonomous Systems: Robust Predictive Algorithms