FIX Can_MainFunction_Mode

[SaharElnagar]

MODIFIED Can_MainFunction_Mode() to poll a flag of the CAN status register until the flag signals that the change takes effect and notify the upper layer with function CanIf_ControllerModeIndication