diag: Fix issues in STM configuration path

Currently, STM related control packet will not be
sent to any peripheral if mask for sensors/wdsp/cdsp
will be enabled along with other peripherals mask.

Also currently not forwarding control packet to
cdsp. The patch takes care to forward the control
packet to desired peripherals and removes diag over
stm support for wdsp since support on peripheral
is absent.

Change-Id: I4e85fd0a21a43a5a3c5089d3c8bad7c23fe1229b
Signed-off-by: Sreelakshmi Gownipalli <sgownipa@codeaurora.org>
Signed-off-by: Mohit Aggarwal <maggarwa@codeaurora.org>