esp32: use semaphore in FP switch test, raise worker task priority See merge request espressif/esp-idf!7526