ARM: i.MX: system.c: Convert goto to if statement