Optimal Control Approach for Active Local Driving Assistance in Mobility Aids