Add scp subsystem option and module stop function

Created by: tarek-arm

This is an updated version of PR #631 after fixing static analysis issues.

@vingu-linaro can you please test this PR one more time to make sure we haven't broken anything?