libsp: Refactoring sp_discovery.c

Remove duplicated code and fix formatting.

Signed-off-by: Imre Kis <imre.kis@arm.com>
Change-Id: Id20852205d2cd02be7e9c821c060eee238f073cf
1 file changed