1 /* 2 * Copyright 2015 Freescale Semiconductor, Inc. 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <fsl_sec_mon.h> 9 10 static u32 get_sec_mon_state(void) 11 { 12 struct ccsr_sec_mon_regs *sec_mon_regs = (void *) 13 (CONFIG_SYS_SEC_MON_ADDR); 14 return sec_mon_in32(&sec_mon_regs->hp_stat) & HPSR_SSM_ST_MASK; 15 } 16 17 static int set_sec_mon_state_non_sec(void) 18 { 19 u32 sts; 20 int timeout = 10; 21 struct ccsr_sec_mon_regs *sec_mon_regs = (void *) 22 (CONFIG_SYS_SEC_MON_ADDR); 23 24 sts = get_sec_mon_state(); 25 26 switch (sts) { 27 /* 28 * If initial state is check or Non-Secure, then set the Software 29 * Security Violation Bit and transition to Non-Secure State. 30 */ 31 case HPSR_SSM_ST_CHECK: 32 printf("SEC_MON state transitioning to Non Secure.\n"); 33 sec_mon_setbits32(&sec_mon_regs->hp_com, HPCOMR_SW_SV); 34 35 /* polling loop till SEC_MON is in Non Secure state */ 36 while (timeout) { 37 sts = get_sec_mon_state(); 38 39 if ((sts & HPSR_SSM_ST_MASK) == 40 HPSR_SSM_ST_NON_SECURE) 41 break; 42 43 udelay(10); 44 timeout--; 45 } 46 47 if (timeout == 0) { 48 printf("SEC_MON state transition timeout.\n"); 49 return -1; 50 } 51 break; 52 53 /* 54 * If initial state is Trusted, Secure or Soft-Fail, then first set 55 * the Software Security Violation Bit and transition to Soft-Fail 56 * State. 57 */ 58 case HPSR_SSM_ST_TRUST: 59 case HPSR_SSM_ST_SECURE: 60 case HPSR_SSM_ST_SOFT_FAIL: 61 printf("SEC_MON state transitioning to Soft Fail.\n"); 62 sec_mon_setbits32(&sec_mon_regs->hp_com, HPCOMR_SW_SV); 63 64 /* polling loop till SEC_MON is in Soft-Fail state */ 65 while (timeout) { 66 sts = get_sec_mon_state(); 67 68 if ((sts & HPSR_SSM_ST_MASK) == 69 HPSR_SSM_ST_SOFT_FAIL) 70 break; 71 72 udelay(10); 73 timeout--; 74 } 75 76 if (timeout == 0) { 77 printf("SEC_MON state transition timeout.\n"); 78 return -1; 79 } 80 81 timeout = 10; 82 83 /* 84 * If SSM Soft Fail to Non-Secure State Transition 85 * disable is not set, then set SSM_ST bit and 86 * transition to Non-Secure State. 87 */ 88 if ((sec_mon_in32(&sec_mon_regs->hp_com) & 89 HPCOMR_SSM_SFNS_DIS) == 0) { 90 printf("SEC_MON state transitioning to Non Secure.\n"); 91 sec_mon_setbits32(&sec_mon_regs->hp_com, HPCOMR_SSM_ST); 92 93 /* polling loop till SEC_MON is in Non Secure*/ 94 while (timeout) { 95 sts = get_sec_mon_state(); 96 97 if ((sts & HPSR_SSM_ST_MASK) == 98 HPSR_SSM_ST_NON_SECURE) 99 break; 100 101 udelay(10); 102 timeout--; 103 } 104 105 if (timeout == 0) { 106 printf("SEC_MON state transition timeout.\n"); 107 return -1; 108 } 109 } 110 break; 111 default: 112 printf("SEC_MON already in Non Secure state.\n"); 113 return 0; 114 } 115 return 0; 116 } 117 118 static int set_sec_mon_state_soft_fail(void) 119 { 120 u32 sts; 121 int timeout = 10; 122 struct ccsr_sec_mon_regs *sec_mon_regs = (void *) 123 (CONFIG_SYS_SEC_MON_ADDR); 124 125 printf("SEC_MON state transitioning to Soft Fail.\n"); 126 sec_mon_setbits32(&sec_mon_regs->hp_com, HPCOMR_SW_FSV); 127 128 /* polling loop till SEC_MON is in Soft-Fail state */ 129 while (timeout) { 130 sts = get_sec_mon_state(); 131 132 if ((sts & HPSR_SSM_ST_MASK) == 133 HPSR_SSM_ST_SOFT_FAIL) 134 break; 135 136 udelay(10); 137 timeout--; 138 } 139 140 if (timeout == 0) { 141 printf("SEC_MON state transition timeout.\n"); 142 return -1; 143 } 144 return 0; 145 } 146 147 int set_sec_mon_state(u32 state) 148 { 149 int ret = -1; 150 151 switch (state) { 152 case HPSR_SSM_ST_NON_SECURE: 153 ret = set_sec_mon_state_non_sec(); 154 break; 155 case HPSR_SSM_ST_SOFT_FAIL: 156 ret = set_sec_mon_state_soft_fail(); 157 break; 158 default: 159 printf("SEC_MON state transition not supported.\n"); 160 return 0; 161 } 162 163 return ret; 164 } 165