kernel/thread: Maintain priority ordering of added mutex waiting threads

The kernel keeps the internal waiting list ordered by priority. This is
trivial to do with std::find_if followed by an insertion.