Optimal Safe Control