cam-service: Move function out of assert

The assert in Zephyr is an empty Macro if debug mode is disabled,
so the function in assert should be moved out, or it will miss
the chance to run.

Signed-off-by: Hongda Deng <hongda.deng@arm.com>