Protect invalid changes of functional modality

There are some cases when the PLC notifies an invalid functional modality request (it asks for 0, that is mapped to fm_Invalid). In some cases, the CS does not ignore this request, and sends to the PLC a command to enter fm_Invalid