-/* Copyright (C) 2013 Czech Technical University in Prague
+/* Copyright (C) 2013, 2015 Czech Technical University in Prague
*
* Authors:
* - Carlos Jenkins <carlos@jenkins.co.cr>
#include "rpp/rpp.h"
+#include "rpp/mutex.h"
-#if rppCONFIG_DRV == 1
+RPP_MUTEX_DEFINE(mutex_lout);
+
+#ifndef FREERTOS_POSIX
#include "drv/lout.h"
+#include "drv/spi_def.h"
#endif
static boolean_t initialized = FALSE;
int8_t rpp_lout_init()
{
- if(initialized) {
- return FAILURE;
- }
- initialized = TRUE;
-#if rppCONFIG_DRV == 1
- spi_tms570_init();
+ if (initialized)
+ return FAILURE;
+ if (!RPP_MUTEX_INIT(mutex_lout))
+ return FAILURE;
+ initialized = TRUE;
+#ifndef FREERTOS_POSIX
+ spi_tms570_init(spi_ifcs, ARRAY_SIZE(spi_ifcs));
#endif
- // FIXME: Implement.
- return SUCCESS;
+ // FIXME: Implement.
+ return SUCCESS;
}
int8_t rpp_lout_set(uint8_t pin, uint8_t val)
{
- if((pin < 1) || (pin > 8)) {
- return -1;
- }
-
- uint8_t index = pin - 1;
- if(val) {
- bit_set(out_cache, index);
- } else {
- bit_clear(out_cache, index);
- }
- return SUCCESS;
+ if ((pin < 1) || (pin > 8))
+ return -1;
+
+ uint8_t index = pin - 1;
+ RPP_MUTEX_LOCK(mutex_lout);
+ if (val)
+ bit_set(out_cache, index);
+ else
+ bit_clear(out_cache, index);
+ RPP_MUTEX_UNLOCK(mutex_lout);
+ return SUCCESS;
}
int8_t rpp_lout_diag(uint8_t pin)
{
- if((pin < 1) || (pin > 8)) {
- return -1;
- }
-
- if(is_bit_set(diag_cache, pin - 1)) {
- return HIGH;
- }
- return LOW;
+ if ((pin < 1) || (pin > 8))
+ return -1;
+
+ int8_t ret_val = LOW;
+
+ RPP_MUTEX_LOCK(mutex_lout);
+ if (is_bit_set(diag_cache, pin - 1))
+ ret_val = HIGH;
+ RPP_MUTEX_UNLOCK(mutex_lout);
+ return ret_val;
}
int8_t rpp_lout_update()
{
- #if rppCONFIG_DRV == 1
- // Update output values
- lout_set_word(out_cache);
- // FIXME: Check which SPI transfer statuses could be considered errors
- lout_spi_transfer();
-
- // Read back diagnostic values
- // FIXME: Implement. Dummy assign for now.
- diag_cache = out_cache;
-
- if(diag_cache != out_cache) {
- return FAILURE;
- }
- #endif
-
- return SUCCESS;
+#ifndef FREERTOS_POSIX
+ RPP_MUTEX_LOCK(mutex_lout);
+ // Update output values
+ lout_set_word(out_cache);
+ // FIXME: Check which SPI transfer statuses could be considered errors
+ lout_spi_transfer();
+
+ // Read back diagnostic values
+ // FIXME: Implement. Dummy assign for now.
+ diag_cache = out_cache;
+
+ if (diag_cache != out_cache) {
+ RPP_MUTEX_UNLOCK(mutex_lout);
+ return FAILURE;
+ }
+ RPP_MUTEX_UNLOCK(mutex_lout);
+#endif
+
+ return SUCCESS;
}