Mode changing code was left out with the DSS driver remodeling. Add the
code back.
Signed-off-by: NTomi Valkeinen <tomi.valkeinen@nokia.com>