diff options
| -rw-r--r-- | os/common/ports/ARMCAx-TZ/chsmc.c | 7 |
1 files changed, 6 insertions, 1 deletions
diff --git a/os/common/ports/ARMCAx-TZ/chsmc.c b/os/common/ports/ARMCAx-TZ/chsmc.c index ef214d757..8aead3865 100644 --- a/os/common/ports/ARMCAx-TZ/chsmc.c +++ b/os/common/ports/ARMCAx-TZ/chsmc.c @@ -78,7 +78,8 @@ static void smcReleaseService(smc_service_t *svc_handle) { rop = chFactoryFindObjectByPointer(svc_handle);
if (rop == NULL)
return;
- chFactoryReleaseObject(rop);
+ chFactoryReleaseObject(rop); /* our ref */
+ chFactoryReleaseObject(rop); /* original ref */
}
#endif
@@ -182,6 +183,10 @@ msg_t smcServiceWaitRequest(smc_service_t *svcp) chDbgCheck(svcp != NULL);
chSysLock();
+ if (_ns_thread) {
+ /* Ack previous service invocation */
+ chThdResumeI(&_ns_thread, MSG_OK);
+ }
r = chThdSuspendTimeoutS(&svcp->svct, TIME_INFINITE);
chSysUnlock();
return r;
|