/* SPDX-License-Identifier: MIT
 * Copyright (c) 2026 Simantic, Inc.
 * Deliberately force a circular wait; FIX_LOCK_ORDER removes it.
 */
#include <zephyr/kernel.h>
#include <zephyr/sys/atomic.h>
#include <zephyr/sys/printk.h>

K_MUTEX_DEFINE(lock_a);
K_MUTEX_DEFINE(lock_b);
static atomic_t worker_a_done;
static atomic_t worker_b_done;

static void worker_a(void *p1, void *p2, void *p3)
{
    ARG_UNUSED(p1); ARG_UNUSED(p2); ARG_UNUSED(p3);
    k_mutex_lock(&lock_a, K_FOREVER);
    k_msleep(50);
    k_mutex_lock(&lock_b, K_FOREVER);
    k_mutex_unlock(&lock_b);
    k_mutex_unlock(&lock_a);
    atomic_set(&worker_a_done, 1);
}

static void worker_b(void *p1, void *p2, void *p3)
{
    ARG_UNUSED(p1); ARG_UNUSED(p2); ARG_UNUSED(p3);
#ifdef FIX_LOCK_ORDER
    struct k_mutex *first = &lock_a, *second = &lock_b;
#else
    struct k_mutex *first = &lock_b, *second = &lock_a;
#endif
    k_mutex_lock(first, K_FOREVER);
    k_msleep(50);
    k_mutex_lock(second, K_FOREVER);
    k_mutex_unlock(second);
    k_mutex_unlock(first);
    atomic_set(&worker_b_done, 1);
}

K_THREAD_DEFINE(worker_a_id, 1024, worker_a, NULL, NULL, NULL, 5, 0, 0);
K_THREAD_DEFINE(worker_b_id, 1024, worker_b, NULL, NULL, NULL, 5, 0, 0);

int main(void)
{
    k_thread_name_set(worker_a_id, "worker_a");
    k_thread_name_set(worker_b_id, "worker_b");
    printk("STM32F401RE: Zephyr mutex debugging\n");
    k_msleep(500);
    int a = atomic_get(&worker_a_done), b = atomic_get(&worker_b_done);
    printk("[progress] worker_a=%d worker_b=%d\n", a, b);
    printk("RESULT: %s\n", a && b ? "PASS" : "FAIL (workers incomplete)");
    return 0;
}
