locked_queue: fix unlocking on Windows
locked_queue: fix unlocking on Windows

It turns out that double unlocking a mutex is not possible on Windows.
Therefore, we need to try to lock it before unlocking it.

dronecore/DroneCore,dronecore/DroneCore,dronecore/DroneCore,dronecore/DroneCore