static void
task1_handler(void *arg)
{
struct os_task *t;
/* Set the led pin for the E407 devboard */
g_led_pin = LED_BLINK_PIN;
hal_gpio_init_out(g_led_pin, 1);
console_printf("\nSensors Test App\n");
while (1) {
t = os_sched_get_current_task();
assert(t->t_func == task1_handler);
++g_task1_loops;
/* Wait one second */
os_time_delay(OS_TICKS_PER_SEC * MYNEWT_VAL(SENSOR_OIC_OBS_RATE));
/* Toggle the LED */
(void)hal_gpio_toggle(g_led_pin);
/* Release semaphore to task 2 */
os_sem_release(&g_test_sem);
}
}
static void
sem_test_1_task1_handler(void *arg)
{
os_error_t err;
struct os_task *t;
int i;;
for (i = 0; i < 3; i++) {
t = os_sched_get_current_task();
TEST_ASSERT(t->t_func == sem_test_1_task1_handler);
err = os_sem_pend(&g_sem1, 0);
TEST_ASSERT(err == OS_OK);
/* Sleep to let other tasks run */
os_time_delay(100);
/* Release the semaphore */
err = os_sem_release(&g_sem1);
TEST_ASSERT(err == OS_OK);
/* Sleep to let other tasks run */
os_time_delay(100);
}
os_test_restart();
}
void
task1_handler(void *arg)
{
struct os_task *t;
/* Set the led pin for the E407 devboard */
g_led_pin = LED_BLINK_PIN;
hal_gpio_init_out(g_led_pin, 1);
while (1) {
t = os_sched_get_current_task();
assert(t->t_func == task1_handler);
++g_task1_loops;
/* Wait one second */
os_time_delay(1000);
/* Toggle the LED */
hal_gpio_toggle(g_led_pin);
/* Release semaphore to task 2 */
os_sem_release(&g_test_sem);
}
}
void
sblinky_spi_irqs_handler(void *arg, int len)
{
struct sblinky_spi_cb_arg *cb;
assert(arg == spi_cb_arg);
if (spi_cb_arg) {
cb = (struct sblinky_spi_cb_arg *)arg;
++cb->transfers;
cb->tx_rx_bytes += len;
cb->txlen = len;
}
/* Post semaphore to task waiting for SPI slave */
os_sem_release(&g_test_sem);
}
static void
sem_test_pend_release_loop(int delay, int timeout, int itvl)
{
os_error_t err;
os_time_delay(delay);
while (1) {
err = os_sem_pend(&g_sem1, timeout);
TEST_ASSERT(err == OS_OK);
err = os_sem_release(&g_sem1);
TEST_ASSERT(err == OS_OK);
os_time_delay(itvl);
}
}
void
task1_handler(void *arg)
{
struct os_task *t;
int prev_pin_state, curr_pin_state;
struct image_version ver;
/* Set the led pin for the E407 devboard */
g_led_pin = LED_BLINK_PIN;
hal_gpio_init_out(g_led_pin, 1);
if (imgr_my_version(&ver) == 0) {
console_printf("\nSlinky_OIC %u.%u.%u.%u\n",
ver.iv_major, ver.iv_minor, ver.iv_revision,
(unsigned int)ver.iv_build_num);
} else {
console_printf("\nSlinky\n");
}
while (1) {
t = os_sched_get_current_task();
assert(t->t_func == task1_handler);
++g_task1_loops;
/* Wait one second */
os_time_delay(OS_TICKS_PER_SEC);
/* Toggle the LED */
prev_pin_state = hal_gpio_read(g_led_pin);
curr_pin_state = hal_gpio_toggle(g_led_pin);
LOG_INFO(&my_log, LOG_MODULE_DEFAULT, "GPIO toggle from %u to %u",
prev_pin_state, curr_pin_state);
STATS_INC(g_stats_gpio_toggle, toggles);
/* Release semaphore to task 2 */
os_sem_release(&g_test_sem);
}
}
static void
wake_interrupt(struct lis2dw12_int * interrupt)
{
bool wake;
OS_ENTER_CRITICAL(interrupt->lock);
if (interrupt->asleep) {
interrupt->asleep = false;
wake = true;
} else {
interrupt->active = true;
wake = false;
}
OS_EXIT_CRITICAL(interrupt->lock);
if (wake) {
os_error_t error;
error = os_sem_release(&interrupt->wait);
assert(error == OS_OK);
}
}
/**
* sem test basic
*
* Basic semaphore tests
*
* @return int
*/
static void
sem_test_basic_handler(void *arg)
{
struct os_task *t;
struct os_sem *sem;
os_error_t err;
sem = &g_sem1;
t = os_sched_get_current_task();
/* Test some error cases */
TEST_ASSERT(os_sem_init(NULL, 1) == OS_INVALID_PARM);
TEST_ASSERT(os_sem_delete(NULL) == OS_INVALID_PARM);
TEST_ASSERT(os_sem_release(NULL) == OS_INVALID_PARM);
TEST_ASSERT(os_sem_pend(NULL, 1) == OS_INVALID_PARM);
/* Get the semaphore */
err = os_sem_pend(sem, 0);
TEST_ASSERT(err == 0,
"Did not get free semaphore immediately (err=%d)", err);
/* Check semaphore internals */
TEST_ASSERT(sem->sem_tokens == 0 && SLIST_EMPTY(&sem->sem_head),
"Semaphore internals wrong after getting semaphore\n"
"%s\n"
"Task: task=%p prio=%u", sem_test_sem_to_s(sem), t, t->t_prio);
/* Get the semaphore again; should fail */
err = os_sem_pend(sem, 0);
TEST_ASSERT(err == OS_TIMEOUT,
"Did not time out waiting for semaphore (err=%d)", err);
/* Check semaphore internals */
TEST_ASSERT(sem->sem_tokens == 0 && SLIST_EMPTY(&sem->sem_head),
"Semaphore internals wrong after getting semaphore\n"
"%s\n"
"Task: task=%p prio=%u\n", sem_test_sem_to_s(sem), t,
t->t_prio);
/* Release semaphore */
err = os_sem_release(sem);
TEST_ASSERT(err == 0,
"Could not release semaphore I own (err=%d)", err);
/* Check semaphore internals */
TEST_ASSERT(sem->sem_tokens == 1 && SLIST_EMPTY(&sem->sem_head),
"Semaphore internals wrong after releasing semaphore\n"
"%s\n"
"Task: task=%p prio=%u\n", sem_test_sem_to_s(sem), t,
t->t_prio);
/* Release it again */
err = os_sem_release(sem);
TEST_ASSERT(err == 0,
"Could not release semaphore again (err=%d)\n", err);
/* Check semaphore internals */
TEST_ASSERT(sem->sem_tokens == 2 && SLIST_EMPTY(&sem->sem_head),
"Semaphore internals wrong after releasing semaphore\n"
"%s\n"
"Task: task=%p prio=%u\n", sem_test_sem_to_s(sem), t,
t->t_prio);
/* "Delete" it */
err = os_sem_delete(sem);
TEST_ASSERT(err == 0,
"Could not delete semaphore (err=%d)", err);
/* Check semaphore internals */
TEST_ASSERT(sem->sem_tokens == 0 && SLIST_EMPTY(&sem->sem_head),
"Semaphore internals wrong after deleting semaphore\n"
"%s\n"
"Task: task=%p prio=%u\n", sem_test_sem_to_s(sem), t,
t->t_prio);
os_test_restart();
}
