AP_HAL_SMACCM: Panic if taking a semaphore held by current thread.

- Catches bugs with attempted recursive semaphore taking.