diag: Handle data_ready count properly

Currently there is a possibility of corrupting
data_ready count while decreasing it. The Patch
fix this with properly decreasing data_ready count.

Change-Id: I86f713afa5f3af24c48ede434251dc529077cd68
Signed-off-by: Hardik Arya <harya@codeaurora.org>