[nrf fromlist] drivers: debug: coresight_nrf: Fix setting Trace ID

Mask STM_STMTCSR_TRACEID_Msk is already bit shifted so Kconfig value
should first be shifted and then masked. The way it was done previously
resulted in TraceID being cleared.

Upstream PR #: 107595

Signed-off-by: Krzysztof Chruściński <krzysztof.chruscinski@nordicsemi.no>

Author: nordic-krch

drivers/debug/debug_coresight_nrf.c

@@ -134,8 +134,8 @@ static void nrf_stm_init(void)
 		sys_write32((1 << STM_STMHEMCR_EN_Pos), stm + STM_STMHEMCR_OFFSET);
 	}
 
-	sys_write32(((CONFIG_DEBUG_CORESIGHT_NRF_ATB_TRACE_ID_STM_GLOBAL & STM_STMTCSR_TRACEID_Msk)
-		     << STM_STMTCSR_TRACEID_Pos) |
+	sys_write32(((CONFIG_DEBUG_CORESIGHT_NRF_ATB_TRACE_ID_STM_GLOBAL << STM_STMTCSR_TRACEID_Pos)
+			& STM_STMTCSR_TRACEID_Msk) |
 			    (1 << STM_STMTCSR_EN_Pos) | (1 << STM_STMTCSR_TSEN_Pos),
 		    stm + STM_STMTCSR_OFFSET);