74 lines
2.1 KiB
C
74 lines
2.1 KiB
C
|
#include <stdio.h>
|
||
|
|
#include "pico/stdlib.h"
|
||
|
|
#include "pico/time.h"
|
||
|
|
#include "FreeRTOS.h"
|
||
|
|
#include "task.h"
|
||
|
|
#include "semphr.h"
|
||
|
|
|
||
|
|
SemaphoreHandle_t xMutex;
|
||
|
|
|
||
|
|
uint32_t getRunTimeCounterValue() {
|
||
|
|
return to_ms_since_boot(get_absolute_time());
|
||
|
|
}
|
||
|
|
|
||
|
|
void taskA(void *params) {
|
||
|
|
while (1) {
|
||
|
|
// Attempt to take the mutex, waiting indefinitely if necessary
|
||
|
|
if (xSemaphoreTake(xMutex, portMAX_DELAY) == pdTRUE) {
|
||
|
|
// Critical section: Access the shared resource
|
||
|
|
printf("Task A: Accessing shared resource\n");
|
||
|
|
vTaskDelay(500 / portTICK_PERIOD_MS); // Simulate work by delaying
|
||
|
|
|
||
|
|
// Release the mutex after finishing work
|
||
|
|
xSemaphoreGive(xMutex);
|
||
|
|
}
|
||
|
|
|
||
|
|
vTaskDelay(1000 / portTICK_PERIOD_MS); // Delay before trying to access again
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void taskB(void *params) {
|
||
|
|
while (1) {
|
||
|
|
// Attempt to take the mutex, waiting indefinitely if necessary
|
||
|
|
if (xSemaphoreTake(xMutex, portMAX_DELAY) == pdTRUE) {
|
||
|
|
// Critical section: Access the shared resource
|
||
|
|
printf("Task B: Accessing shared resource\n");
|
||
|
|
vTaskDelay(500 / portTICK_PERIOD_MS); // Simulate work by delaying
|
||
|
|
|
||
|
|
// Release the mutex after finishing work
|
||
|
|
xSemaphoreGive(xMutex);
|
||
|
|
}
|
||
|
|
|
||
|
|
vTaskDelay(1500 / portTICK_PERIOD_MS); // Delay before trying to access again
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void printTaskStats(void *params) {
|
||
|
|
char buffer[256];
|
||
|
|
while (1) {
|
||
|
|
vTaskGetRunTimeStats(buffer);
|
||
|
|
printf("Task run-time stats:\n%s\n", buffer);
|
||
|
|
vTaskDelay(pdMS_TO_TICKS(5000)); // Print stats every 5 seconds
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int main() {
|
||
|
|
stdio_init_all(); // Initialize stdio over USB
|
||
|
|
|
||
|
|
// Create a semaphore
|
||
|
|
xMutex = xSemaphoreCreateMutex();
|
||
|
|
if (xMutex == NULL) {
|
||
|
|
printf("Failed to create mutex\n");
|
||
|
|
while (1); // Loop forever if mutex creation fails
|
||
|
|
}
|
||
|
|
|
||
|
|
xTaskCreate(taskA, "Task A", 1024, NULL, 1, NULL);
|
||
|
|
xTaskCreate(taskB, "Task B", 1024, NULL, 1, NULL);
|
||
|
|
xTaskCreate(printTaskStats, "Stats Printer", 1024, NULL, 1, NULL);
|
||
|
|
|
||
|
|
vTaskStartScheduler(); // Start FreeRTOS scheduler
|
||
|
|
|
||
|
|
for (;;);
|
||
|
|
}
|
||
|
|
|