Make sure that there is one space after for
This commit is contained in:
parent
056aed1274
commit
494387b33b
@ -81,7 +81,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (g_irqtos || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (g_irqtos || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -207,7 +207,7 @@ void os_start(void)
|
|||||||
|
|
||||||
_up_puts("Test complete");
|
_up_puts("Test complete");
|
||||||
_up_putnl();
|
_up_putnl();
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
|
||||||
/************************************************************************
|
/************************************************************************
|
||||||
|
@ -301,7 +301,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -317,7 +317,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -312,7 +312,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -327,7 +327,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -185,7 +185,7 @@ pid_t up_vfork(const struct vfork_s *context)
|
|||||||
/* Make some feeble effort to perserve the stack contents. This is
|
/* Make some feeble effort to perserve the stack contents. This is
|
||||||
* feeble because the stack surely contains invalid pointers and other
|
* feeble because the stack surely contains invalid pointers and other
|
||||||
* content that will not work in the child context. However, if the
|
* content that will not work in the child context. However, if the
|
||||||
* user follows all of the caveats of vfor() usage, even this feeble
|
* user follows all of the caveats of vfork() usage, even this feeble
|
||||||
* effort is overkill.
|
* effort is overkill.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
@ -493,7 +493,7 @@ static int up_interrupt(int irq, void *context)
|
|||||||
* until we have been looping for a long time.
|
* until we have been looping for a long time.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* Get the current UART status and check for loop
|
/* Get the current UART status and check for loop
|
||||||
* termination conditions
|
* termination conditions
|
||||||
|
@ -832,7 +832,7 @@ static int up_interrupt(int irq, void *context)
|
|||||||
* until we have been looping for a long time.
|
* until we have been looping for a long time.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* Get the current UART status and check for loop
|
/* Get the current UART status and check for loop
|
||||||
* termination conditions
|
* termination conditions
|
||||||
|
@ -165,5 +165,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shouldn't get here */
|
/* Shouldn't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -181,6 +181,6 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shoulnd't get here */
|
/* Shoulnd't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -257,5 +257,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shouldn't get here */
|
/* Shouldn't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -357,5 +357,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shouldn't get here */
|
/* Shouldn't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -174,5 +174,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shoulnd't get here */
|
/* Shoulnd't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -191,5 +191,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shouldn't get here */
|
/* Shouldn't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -175,5 +175,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shoulnd't get here */
|
/* Shoulnd't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -306,6 +306,6 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shoulnd't get here */
|
/* Shoulnd't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
@ -165,5 +165,5 @@ void __start(void)
|
|||||||
|
|
||||||
/* Shoulnd't get here */
|
/* Shoulnd't get here */
|
||||||
|
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -105,7 +105,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -280,7 +280,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -105,7 +105,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -190,7 +190,7 @@ pid_t up_vfork(const struct vfork_s *context)
|
|||||||
/* Make some feeble effort to perserve the stack contents. This is
|
/* Make some feeble effort to perserve the stack contents. This is
|
||||||
* feeble because the stack surely contains invalid pointers and other
|
* feeble because the stack surely contains invalid pointers and other
|
||||||
* content that will not work in the child context. However, if the
|
* content that will not work in the child context. However, if the
|
||||||
* user follows all of the caveats of vfor() usage, even this feeble
|
* user follows all of the caveats of vfork() usage, even this feeble
|
||||||
* effort is overkill.
|
* effort is overkill.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
@ -92,7 +92,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -242,7 +242,7 @@ static void _up_assert(int errorcode)
|
|||||||
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (current_regs || ((struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -294,12 +294,12 @@ static int init_graph_vga(int width, int height,int chain4)
|
|||||||
outb(val, 0x3c2);
|
outb(val, 0x3c2);
|
||||||
outw(0x0e11, 0x3d4); /* enable regs 0-7 */
|
outw(0x0e11, 0x3d4); /* enable regs 0-7 */
|
||||||
|
|
||||||
for(a = 0; a < SZ(g_hor_regs); ++a)
|
for (a = 0; a < SZ(g_hor_regs); ++a)
|
||||||
{
|
{
|
||||||
outw((uint16_t)((w[a] << 8) + g_hor_regs[a]), 0x3d4);
|
outw((uint16_t)((w[a] << 8) + g_hor_regs[a]), 0x3d4);
|
||||||
}
|
}
|
||||||
|
|
||||||
for(a = 0; a < SZ(g_ver_regs); ++a)
|
for (a = 0; a < SZ(g_ver_regs); ++a)
|
||||||
{
|
{
|
||||||
outw((uint16_t)((h[a] << 8) + g_ver_regs[a]), 0x3d4);
|
outw((uint16_t)((h[a] << 8) + g_ver_regs[a]), 0x3d4);
|
||||||
}
|
}
|
||||||
@ -330,7 +330,7 @@ static int init_graph_vga(int width, int height,int chain4)
|
|||||||
outb(0x33, 0x3c0);
|
outb(0x33, 0x3c0);
|
||||||
outb(0x00, 0x3c0);
|
outb(0x00, 0x3c0);
|
||||||
|
|
||||||
for(a = 0; a < 16; a++) /* ega pal */
|
for (a = 0; a < 16; a++) /* ega pal */
|
||||||
{
|
{
|
||||||
outb((uint8_t)a, 0x3c0);
|
outb((uint8_t)a, 0x3c0);
|
||||||
outb((uint8_t)a, 0x3c0);
|
outb((uint8_t)a, 0x3c0);
|
||||||
|
@ -91,7 +91,7 @@ static void _up_assert(int errorcode) /* noreturn_function */
|
|||||||
if (up_interrupt_context() || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (up_interrupt_context() || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -90,7 +90,7 @@ static void _up_assert(int errorcode) /* noreturn_function */
|
|||||||
if (up_interrupt_context() || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
if (up_interrupt_context() || ((FAR struct tcb_s*)g_readytorun.head)->pid == 0)
|
||||||
{
|
{
|
||||||
(void)irqsave();
|
(void)irqsave();
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
#ifdef CONFIG_ARCH_LEDS
|
#ifdef CONFIG_ARCH_LEDS
|
||||||
board_led_on(LED_PANIC);
|
board_led_on(LED_PANIC);
|
||||||
|
@ -300,7 +300,7 @@ static uint8_t spi_transfer(uint8_t ch)
|
|||||||
|
|
||||||
/* Send the byte, repeating if some error occurs */
|
/* Send the byte, repeating if some error occurs */
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
outp(EZ80_SPI_TSR, ch);
|
outp(EZ80_SPI_TSR, ch);
|
||||||
|
|
||||||
|
@ -195,7 +195,7 @@ void open1788_sdram_initialize(void)
|
|||||||
|
|
||||||
/* Wait 128 AHB clock cycles */
|
/* Wait 128 AHB clock cycles */
|
||||||
|
|
||||||
for(i = 0; i < 128; i++);
|
for (i = 0; i < 128; i++);
|
||||||
|
|
||||||
/* 64ms/8192 = 7.8125us, nx16x8.33ns < 7.8125us, n < 58.6*/
|
/* 64ms/8192 = 7.8125us, nx16x8.33ns < 7.8125us, n < 58.6*/
|
||||||
|
|
||||||
|
@ -665,7 +665,7 @@ int main(int argc, char **argv, char **envp)
|
|||||||
|
|
||||||
/* Loopo until control-C */
|
/* Loopo until control-C */
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* Read characters from the console, and echo them to the target tty */
|
/* Read characters from the console, and echo them to the target tty */
|
||||||
|
|
||||||
|
@ -104,5 +104,5 @@ void board_power_off(void)
|
|||||||
|
|
||||||
// trigger shutdown with pull-up resistor (not push-pull!) and wait.
|
// trigger shutdown with pull-up resistor (not push-pull!) and wait.
|
||||||
stm32_gpiowrite(GPIO_PCLR, true);
|
stm32_gpiowrite(GPIO_PCLR, true);
|
||||||
for(;;);
|
for (;;);
|
||||||
}
|
}
|
||||||
|
@ -38,33 +38,33 @@
|
|||||||
/** \file
|
/** \file
|
||||||
* \author Uros Platise
|
* \author Uros Platise
|
||||||
* \brief VSN Sensor Interface
|
* \brief VSN Sensor Interface
|
||||||
*
|
*
|
||||||
* Public interface:
|
* Public interface:
|
||||||
* - sif_init(): should be called just once after system starts, to
|
* - sif_init(): should be called just once after system starts, to
|
||||||
* initialize internal data structures, device driver and hardware
|
* initialize internal data structures, device driver and hardware
|
||||||
* - individual starts() and stops() that control gpio, usart, i2c, ...
|
* - individual starts() and stops() that control gpio, usart, i2c, ...
|
||||||
* are wrapped throu open() and close()
|
* are wrapped throu open() and close()
|
||||||
* - read() and write() are used for streaming
|
* - read() and write() are used for streaming
|
||||||
* - ioctl() for configuration
|
* - ioctl() for configuration
|
||||||
*
|
*
|
||||||
* STDOUT Coding 16-bit (little endian):
|
* STDOUT Coding 16-bit (little endian):
|
||||||
* - MSB = 0 GPIOs, followed by the both GPIO config bytes
|
* - MSB = 0 GPIOs, followed by the both GPIO config bytes
|
||||||
* - MSB = 1 Input AD, centered around 0x4000
|
* - MSB = 1 Input AD, centered around 0x4000
|
||||||
*
|
*
|
||||||
* STDIN Coding 16-bit (little endian):
|
* STDIN Coding 16-bit (little endian):
|
||||||
* - MSB = 0 GPIOs, followed by the both GPIO config bytes
|
* - MSB = 0 GPIOs, followed by the both GPIO config bytes
|
||||||
* - MSB-1 = 0 Analog Output (PWM or Power)
|
* - MSB-1 = 0 Analog Output (PWM or Power)
|
||||||
* - MSB-1 = 1 Analog Reference Tap
|
* - MSB-1 = 1 Analog Reference Tap
|
||||||
*
|
*
|
||||||
* GPIO Update cycle:
|
* GPIO Update cycle:
|
||||||
* - if they follow the Analog Output, they are synced with them
|
* - if they follow the Analog Output, they are synced with them
|
||||||
* - if they follow the Analog Reference Tap, they are synced with them
|
* - if they follow the Analog Reference Tap, they are synced with them
|
||||||
* - if either is configured without sample rate value, they are updated
|
* - if either is configured without sample rate value, they are updated
|
||||||
* immediately, same as them
|
* immediately, same as them
|
||||||
*
|
*
|
||||||
* Implementation:
|
* Implementation:
|
||||||
* - Complete internal states and updateing is made via the struct
|
* - Complete internal states and updateing is made via the struct
|
||||||
* vsn_sif_s, which is also accessible thru the ioctl() with
|
* vsn_sif_s, which is also accessible thru the ioctl() with
|
||||||
* SNP Message descriptor.
|
* SNP Message descriptor.
|
||||||
**/
|
**/
|
||||||
|
|
||||||
@ -94,8 +94,8 @@
|
|||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Declarations and Structures
|
* Declarations and Structures
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
#define VSN_SIF_READ_BUFSIZE 128
|
#define VSN_SIF_READ_BUFSIZE 128
|
||||||
#define VSN_SIF_WRITE_BUFSIZE 128
|
#define VSN_SIF_WRITE_BUFSIZE 128
|
||||||
|
|
||||||
@ -131,7 +131,7 @@ typedef unsigned char vsn_sif_gpio_t;
|
|||||||
#define VSN_SIF_ANOUT_LOW 0 // Pseudo Analog Output acts as GPIO
|
#define VSN_SIF_ANOUT_LOW 0 // Pseudo Analog Output acts as GPIO
|
||||||
#define VSN_SIF_ANOUT_HIGH 1 // Pseudo Analog Output acts as GPIO high
|
#define VSN_SIF_ANOUT_HIGH 1 // Pseudo Analog Output acts as GPIO high
|
||||||
#define VSN_SIF_ANOUT_HIGHPWR 2 // ... acts as high power output
|
#define VSN_SIF_ANOUT_HIGHPWR 2 // ... acts as high power output
|
||||||
#define VSN_SIF_ANOUT_PWM 3 // ... acts as PWM output
|
#define VSN_SIF_ANOUT_PWM 3 // ... acts as PWM output
|
||||||
#define VSN_SIF_ANOUT_PWMPWR 4 // acts as power PWM output
|
#define VSN_SIF_ANOUT_PWMPWR 4 // acts as power PWM output
|
||||||
|
|
||||||
#define VSN_SIF_ANIN_GAINMASK 7
|
#define VSN_SIF_ANIN_GAINMASK 7
|
||||||
@ -160,7 +160,7 @@ typedef unsigned char vsn_sif_gpio_t;
|
|||||||
|
|
||||||
|
|
||||||
struct vsn_sif_s {
|
struct vsn_sif_s {
|
||||||
vsn_sif_state_t state; // activity
|
vsn_sif_state_t state; // activity
|
||||||
unsigned char opencnt; // open count
|
unsigned char opencnt; // open count
|
||||||
|
|
||||||
vsn_sif_gpio_t gpio[2];
|
vsn_sif_gpio_t gpio[2];
|
||||||
@ -173,68 +173,62 @@ struct vsn_sif_s {
|
|||||||
unsigned short int anref_width;
|
unsigned short int anref_width;
|
||||||
unsigned short int anref_period; // setting it to 0, disables PWM
|
unsigned short int anref_period; // setting it to 0, disables PWM
|
||||||
unsigned short int anref_samplerate; // as written by write()
|
unsigned short int anref_samplerate; // as written by write()
|
||||||
|
|
||||||
unsigned char anin_opts;
|
unsigned char anin_opts;
|
||||||
unsigned int anin_samplerate; // returned on read() as 16-bit results
|
unsigned int anin_samplerate; // returned on read() as 16-bit results
|
||||||
|
|
||||||
/*--- Private Data ---*/
|
/*--- Private Data ---*/
|
||||||
|
|
||||||
struct stm32_tim_dev_s * tim3; // Timer3 is used for PWM, and Analog RefTap
|
struct stm32_tim_dev_s * tim3; // Timer3 is used for PWM, and Analog RefTap
|
||||||
struct stm32_tim_dev_s * tim8; // Timer8 is used for Power Switch
|
struct stm32_tim_dev_s * tim8; // Timer8 is used for Power Switch
|
||||||
|
|
||||||
struct i2c_dev_s * i2c1;
|
struct i2c_dev_s * i2c1;
|
||||||
struct i2c_dev_s * i2c2;
|
struct i2c_dev_s * i2c2;
|
||||||
|
|
||||||
struct spi_dev_s * spi2;
|
struct spi_dev_s * spi2;
|
||||||
|
|
||||||
sem_t exclusive_access;
|
sem_t exclusive_access;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Private data
|
* Private data
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
struct vsn_sif_s vsn_sif;
|
struct vsn_sif_s vsn_sif;
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Semaphores
|
* Semaphores
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
void sif_sem_wait(void)
|
void sif_sem_wait(void)
|
||||||
{
|
{
|
||||||
while (sem_wait( &vsn_sif.exclusive_access ) != 0)
|
while (sem_wait(&vsn_sif.exclusive_access) != 0)
|
||||||
{
|
{
|
||||||
ASSERT(errno == EINTR);
|
ASSERT(errno == EINTR);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void inline sif_sem_post(void)
|
void inline sif_sem_post(void)
|
||||||
{
|
{
|
||||||
sem_post( &vsn_sif.exclusive_access );
|
sem_post(&vsn_sif.exclusive_access);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* GPIOs and Alternative Functions
|
* GPIOs and Alternative Functions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
|
||||||
void sif_gpios_reset(void)
|
void sif_gpios_reset(void)
|
||||||
{
|
{
|
||||||
vsn_sif.gpio[0] = vsn_sif.gpio[1] = VSN_SIF_GPIO_HIGHZ;
|
vsn_sif.gpio[0] = vsn_sif.gpio[1] = VSN_SIF_GPIO_HIGHZ;
|
||||||
|
|
||||||
stm32_configgpio(GPIO_GP1_HIZ);
|
stm32_configgpio(GPIO_GP1_HIZ);
|
||||||
stm32_configgpio(GPIO_GP2_HIZ);
|
stm32_configgpio(GPIO_GP2_HIZ);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void sif_gpio1_update(void)
|
void sif_gpio1_update(void)
|
||||||
{
|
{
|
||||||
uint32_t val;
|
uint32_t val;
|
||||||
|
|
||||||
switch(vsn_sif.gpio[0] & VSN_SIF_GPIO_STATE_MASK) {
|
switch(vsn_sif.gpio[0] & VSN_SIF_GPIO_STATE_MASK) {
|
||||||
case VSN_SIF_GPIO_HIGHZ: val = GPIO_GP1_HIZ; break;
|
case VSN_SIF_GPIO_HIGHZ: val = GPIO_GP1_HIZ; break;
|
||||||
case VSN_SIF_GPIO_PULLUP: val = GPIO_GP1_PUP; break;
|
case VSN_SIF_GPIO_PULLUP: val = GPIO_GP1_PUP; break;
|
||||||
@ -245,17 +239,16 @@ void sif_gpio1_update(void)
|
|||||||
}
|
}
|
||||||
if (stm32_configgpio(val) == ERROR)
|
if (stm32_configgpio(val) == ERROR)
|
||||||
printf("Error updating1\n");
|
printf("Error updating1\n");
|
||||||
|
|
||||||
if ( stm32_gpioread(val) )
|
if (stm32_gpioread(val))
|
||||||
vsn_sif.gpio[0] |= VSN_SIF_GPIO_READ_MASK;
|
vsn_sif.gpio[0] |= VSN_SIF_GPIO_READ_MASK;
|
||||||
else vsn_sif.gpio[0] &= ~VSN_SIF_GPIO_READ_MASK;
|
else vsn_sif.gpio[0] &= ~VSN_SIF_GPIO_READ_MASK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void sif_gpio2_update(void)
|
void sif_gpio2_update(void)
|
||||||
{
|
{
|
||||||
uint32_t val;
|
uint32_t val;
|
||||||
|
|
||||||
switch(vsn_sif.gpio[1]) {
|
switch(vsn_sif.gpio[1]) {
|
||||||
case VSN_SIF_GPIO_HIGHZ: val = GPIO_GP2_HIZ; break;
|
case VSN_SIF_GPIO_HIGHZ: val = GPIO_GP2_HIZ; break;
|
||||||
case VSN_SIF_GPIO_PULLUP: val = GPIO_GP2_PUP; break;
|
case VSN_SIF_GPIO_PULLUP: val = GPIO_GP2_PUP; break;
|
||||||
@ -266,13 +259,12 @@ void sif_gpio2_update(void)
|
|||||||
}
|
}
|
||||||
if (stm32_configgpio(val) == ERROR)
|
if (stm32_configgpio(val) == ERROR)
|
||||||
printf("Error updating2\n");
|
printf("Error updating2\n");
|
||||||
|
|
||||||
if ( stm32_gpioread(val) )
|
if (stm32_gpioread(val))
|
||||||
vsn_sif.gpio[1] |= VSN_SIF_GPIO_READ_MASK;
|
vsn_sif.gpio[1] |= VSN_SIF_GPIO_READ_MASK;
|
||||||
else vsn_sif.gpio[1] &= ~VSN_SIF_GPIO_READ_MASK;
|
else vsn_sif.gpio[1] &= ~VSN_SIF_GPIO_READ_MASK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int sif_gpios_lock(vsn_sif_state_t peripheral)
|
int sif_gpios_lock(vsn_sif_state_t peripheral)
|
||||||
{
|
{
|
||||||
return ERROR;
|
return ERROR;
|
||||||
@ -284,15 +276,11 @@ int sif_gpios_unlock(vsn_sif_state_t peripheral)
|
|||||||
return ERROR;
|
return ERROR;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Analog Outputs
|
* Analog Outputs
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
static volatile int test = 0, teirq;
|
|
||||||
|
|
||||||
|
static volatile int test = 0, teirq;
|
||||||
|
|
||||||
static int sif_anout_isr(int irq, void *context)
|
static int sif_anout_isr(int irq, void *context)
|
||||||
{
|
{
|
||||||
@ -300,42 +288,41 @@ static int sif_anout_isr(int irq, void *context)
|
|||||||
|
|
||||||
test++;
|
test++;
|
||||||
teirq = irq;
|
teirq = irq;
|
||||||
|
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int sif_anout_init(void)
|
int sif_anout_init(void)
|
||||||
{
|
{
|
||||||
vsn_sif.tim3 = stm32_tim_init(3);
|
vsn_sif.tim3 = stm32_tim_init(3);
|
||||||
vsn_sif.tim8 = stm32_tim_init(8);
|
vsn_sif.tim8 = stm32_tim_init(8);
|
||||||
|
|
||||||
if (!vsn_sif.tim3 || !vsn_sif.tim8) return ERROR;
|
if (!vsn_sif.tim3 || !vsn_sif.tim8) return ERROR;
|
||||||
|
|
||||||
// Use the TIM3 as PWM modulated analogue output
|
// Use the TIM3 as PWM modulated analogue output
|
||||||
|
|
||||||
STM32_TIM_SETPERIOD(vsn_sif.tim3, 5);
|
STM32_TIM_SETPERIOD(vsn_sif.tim3, 5);
|
||||||
STM32_TIM_SETCOMPARE(vsn_sif.tim3, GPIO_OUT_PWM_TIM3_CH, 3);
|
STM32_TIM_SETCOMPARE(vsn_sif.tim3, GPIO_OUT_PWM_TIM3_CH, 3);
|
||||||
|
|
||||||
STM32_TIM_SETCLOCK(vsn_sif.tim3, 36e6);
|
STM32_TIM_SETCLOCK(vsn_sif.tim3, 36e6);
|
||||||
STM32_TIM_SETMODE(vsn_sif.tim3, STM32_TIM_MODE_UP);
|
STM32_TIM_SETMODE(vsn_sif.tim3, STM32_TIM_MODE_UP);
|
||||||
STM32_TIM_SETCHANNEL(vsn_sif.tim3, GPIO_OUT_PWM_TIM3_CH, STM32_TIM_CH_OUTPWM | STM32_TIM_CH_POLARITY_NEG);
|
STM32_TIM_SETCHANNEL(vsn_sif.tim3, GPIO_OUT_PWM_TIM3_CH, STM32_TIM_CH_OUTPWM | STM32_TIM_CH_POLARITY_NEG);
|
||||||
|
|
||||||
// Use the TIM8 to drive the upper power mosfet
|
// Use the TIM8 to drive the upper power mosfet
|
||||||
|
|
||||||
STM32_TIM_SETISR(vsn_sif.tim8, sif_anout_isr, 0);
|
STM32_TIM_SETISR(vsn_sif.tim8, sif_anout_isr, 0);
|
||||||
STM32_TIM_ENABLEINT(vsn_sif.tim8, 0);
|
STM32_TIM_ENABLEINT(vsn_sif.tim8, 0);
|
||||||
|
|
||||||
STM32_TIM_SETPERIOD(vsn_sif.tim8, 4096);
|
STM32_TIM_SETPERIOD(vsn_sif.tim8, 4096);
|
||||||
STM32_TIM_SETCOMPARE(vsn_sif.tim8, GPIO_OUT_PWRPWM_TIM8_CH, 5000);
|
STM32_TIM_SETCOMPARE(vsn_sif.tim8, GPIO_OUT_PWRPWM_TIM8_CH, 5000);
|
||||||
|
|
||||||
STM32_TIM_SETCLOCK(vsn_sif.tim8, 36e6);
|
STM32_TIM_SETCLOCK(vsn_sif.tim8, 36e6);
|
||||||
STM32_TIM_SETMODE(vsn_sif.tim8, STM32_TIM_MODE_UP);
|
STM32_TIM_SETMODE(vsn_sif.tim8, STM32_TIM_MODE_UP);
|
||||||
//STM32_TIM_SETCHANNEL(vsn_sif.tim8, GPIO_OUT_PWRPWM_TIM8_CH, STM32_TIM_CH_OUTPWM | STM32_TIM_CH_POLARITY_NEG);
|
//STM32_TIM_SETCHANNEL(vsn_sif.tim8, GPIO_OUT_PWRPWM_TIM8_CH, STM32_TIM_CH_OUTPWM | STM32_TIM_CH_POLARITY_NEG);
|
||||||
|
|
||||||
vsn_sif.i2c1 = up_i2cinitialize(1);
|
vsn_sif.i2c1 = up_i2cinitialize(1);
|
||||||
vsn_sif.i2c2 = up_i2cinitialize(2);
|
vsn_sif.i2c2 = up_i2cinitialize(2);
|
||||||
|
|
||||||
vsn_sif.spi2 = up_spiinitialize(2);
|
vsn_sif.spi2 = up_spiinitialize(2);
|
||||||
|
|
||||||
return OK;
|
return OK;
|
||||||
@ -346,43 +333,39 @@ void sif_anout_update(void)
|
|||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void sif_anout_callback(void)
|
void sif_anout_callback(void)
|
||||||
{
|
{
|
||||||
// called at rate of PWM interrupt
|
// called at rate of PWM interrupt
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Analog Input Reference Tap
|
* Analog Input Reference Tap
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
|
||||||
void sif_anref_init(void)
|
void sif_anref_init(void)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Analog Input Sampler Unit
|
* Analog Input Sampler Unit
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
/**
|
/**
|
||||||
* Gain is set using the shared multiplexed bus with the SDIO card.
|
* Gain is set using the shared multiplexed bus with the SDIO card.
|
||||||
* The following rules apply for the SDcard:
|
* The following rules apply for the SDcard:
|
||||||
*
|
*
|
||||||
* - CMD serial line always starts with 0 (start-bit) and ends with 1 (stop-bit)
|
* - CMD serial line always starts with 0 (start-bit) and ends with 1 (stop-bit)
|
||||||
* The total length is always 48 bits protected by CRCs. When changing the
|
* The total length is always 48 bits protected by CRCs. When changing the
|
||||||
* gain, CMD must be seen as 1 on CK changes.
|
* gain, CMD must be seen as 1 on CK changes.
|
||||||
*
|
*
|
||||||
* - An alternative mechanism would be to use suspend/resume commands
|
* - An alternative mechanism would be to use suspend/resume commands
|
||||||
*
|
*
|
||||||
* - If SDcard internal shift-register is 8-bit oriented there might be a need
|
* - If SDcard internal shift-register is 8-bit oriented there might be a need
|
||||||
* to shift 7 dummy bits to properly detect invalid start of packet
|
* to shift 7 dummy bits to properly detect invalid start of packet
|
||||||
* (with start bit set as 1) to invalidate bus transitions (in case CK
|
* (with start bit set as 1) to invalidate bus transitions (in case CK
|
||||||
* is changing).
|
* is changing).
|
||||||
*
|
*
|
||||||
* SDIO returns the bus in HiZ states, where CLK = 0, D = CMD = external pull-up
|
* SDIO returns the bus in HiZ states, where CLK = 0, D = CMD = external pull-up
|
||||||
*/
|
*/
|
||||||
int sif_anin_setgain(int gain)
|
int sif_anin_setgain(int gain)
|
||||||
@ -390,92 +373,88 @@ int sif_anin_setgain(int gain)
|
|||||||
/* Shutdown the PGA and exit if gain is invalid */
|
/* Shutdown the PGA and exit if gain is invalid */
|
||||||
|
|
||||||
stm32_gpiowrite(GPIO_PGIA_AEN, FALSE);
|
stm32_gpiowrite(GPIO_PGIA_AEN, FALSE);
|
||||||
|
|
||||||
if (gain < 0 || gain > 7)
|
if (gain < 0 || gain > 7)
|
||||||
return -1;
|
return -1;
|
||||||
|
|
||||||
sdio_gpio_request();
|
sdio_gpio_request();
|
||||||
|
|
||||||
/* If we have to set CLK = 1, made that first as D, CMD are 1 by pull-ups */
|
/* If we have to set CLK = 1, made that first as D, CMD are 1 by pull-ups */
|
||||||
|
|
||||||
if (gain & 2)
|
if (gain & 2)
|
||||||
stm32_configgpio(GPIO_PGIA_A1_H);
|
stm32_configgpio(GPIO_PGIA_A1_H);
|
||||||
else stm32_configgpio(GPIO_PGIA_A1_L);
|
else stm32_configgpio(GPIO_PGIA_A1_L);
|
||||||
|
|
||||||
/* Set the D and CMD bits */
|
/* Set the D and CMD bits */
|
||||||
|
|
||||||
if (gain & 1)
|
if (gain & 1)
|
||||||
stm32_configgpio(GPIO_PGIA_A0_H);
|
stm32_configgpio(GPIO_PGIA_A0_H);
|
||||||
else stm32_configgpio(GPIO_PGIA_A0_L);
|
else stm32_configgpio(GPIO_PGIA_A0_L);
|
||||||
|
|
||||||
if (gain & 4)
|
if (gain & 4)
|
||||||
stm32_configgpio(GPIO_PGIA_A2_H);
|
stm32_configgpio(GPIO_PGIA_A2_H);
|
||||||
else stm32_configgpio(GPIO_PGIA_A2_L);
|
else stm32_configgpio(GPIO_PGIA_A2_L);
|
||||||
|
|
||||||
/* Sample GAIN on rising edge */
|
/* Sample GAIN on rising edge */
|
||||||
|
|
||||||
stm32_gpiowrite(GPIO_PGIA_AEN, TRUE);
|
stm32_gpiowrite(GPIO_PGIA_AEN, TRUE);
|
||||||
|
|
||||||
/* Release D and CMD pins to 1; however shorten rising edge actively */
|
/* Release D and CMD pins to 1; however shorten rising edge actively */
|
||||||
|
|
||||||
stm32_gpiowrite(GPIO_PGIA_A0_H, TRUE);
|
stm32_gpiowrite(GPIO_PGIA_A0_H, TRUE);
|
||||||
stm32_gpiowrite(GPIO_PGIA_A2_H, TRUE);
|
stm32_gpiowrite(GPIO_PGIA_A2_H, TRUE);
|
||||||
|
|
||||||
stm32_unconfiggpio(GPIO_PGIA_A0_H);
|
stm32_unconfiggpio(GPIO_PGIA_A0_H);
|
||||||
stm32_unconfiggpio(GPIO_PGIA_A2_H);
|
stm32_unconfiggpio(GPIO_PGIA_A2_H);
|
||||||
|
|
||||||
/* Release CLK by going down */
|
/* Release CLK by going down */
|
||||||
|
|
||||||
stm32_unconfiggpio(GPIO_PGIA_A1_L);
|
stm32_unconfiggpio(GPIO_PGIA_A1_L);
|
||||||
|
|
||||||
sdio_gpio_release();
|
sdio_gpio_release();
|
||||||
|
|
||||||
return gain;
|
return gain;
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
int sif_anin_reset(void)
|
int sif_anin_reset(void)
|
||||||
{
|
{
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Device driver functions
|
* Device driver functions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
int devsif_open(FAR struct file *filep)
|
int devsif_open(FAR struct file *filep)
|
||||||
{
|
{
|
||||||
sif_sem_wait();
|
sif_sem_wait();
|
||||||
vsn_sif.opencnt++;
|
vsn_sif.opencnt++;
|
||||||
|
|
||||||
// Start Hardware
|
// Start Hardware
|
||||||
|
|
||||||
sif_sem_post();
|
sif_sem_post();
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int devsif_close(FAR struct file *filep)
|
int devsif_close(FAR struct file *filep)
|
||||||
{
|
{
|
||||||
sif_sem_wait();
|
sif_sem_wait();
|
||||||
|
|
||||||
if (--vsn_sif.opencnt) {
|
if (--vsn_sif.opencnt) {
|
||||||
|
|
||||||
// suspend (powerdown) hardware
|
// suspend (powerdown) hardware
|
||||||
|
|
||||||
sif_gpios_reset();
|
sif_gpios_reset();
|
||||||
|
|
||||||
//STM32_TIM_SETCLOCK(vsn_sif.tim3, 0);
|
//STM32_TIM_SETCLOCK(vsn_sif.tim3, 0);
|
||||||
//STM32_TIM_SETCLOCK(vsn_sif.tim8, 0);
|
//STM32_TIM_SETCLOCK(vsn_sif.tim8, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
sif_sem_post();
|
sif_sem_post();
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static ssize_t devsif_read(FAR struct file *filep, FAR char *buffer, size_t len)
|
static ssize_t devsif_read(FAR struct file *filep, FAR char *buffer, size_t len)
|
||||||
{
|
{
|
||||||
sif_sem_wait();
|
sif_sem_wait();
|
||||||
@ -484,23 +463,21 @@ static ssize_t devsif_read(FAR struct file *filep, FAR char *buffer, size_t len)
|
|||||||
return len;
|
return len;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static ssize_t devsif_write(FAR struct file *filep, FAR const char *buffer, size_t len)
|
static ssize_t devsif_write(FAR struct file *filep, FAR const char *buffer, size_t len)
|
||||||
{
|
{
|
||||||
sif_sem_wait();
|
sif_sem_wait();
|
||||||
printf("getpid: %d\n", getpid() );
|
printf("getpid: %d\n", getpid());
|
||||||
sif_sem_post();
|
sif_sem_post();
|
||||||
return len;
|
return len;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
#ifndef CONFIG_DISABLE_POLL
|
#ifndef CONFIG_DISABLE_POLL
|
||||||
static int devsif_poll(FAR struct file *filep, FAR struct pollfd *fds,
|
static int devsif_poll(FAR struct file *filep, FAR struct pollfd *fds,
|
||||||
bool setup)
|
bool setup)
|
||||||
{
|
{
|
||||||
if (setup) {
|
if (setup) {
|
||||||
fds->revents |= (fds->events & (POLLIN|POLLOUT));
|
fds->revents |= (fds->events & (POLLIN|POLLOUT));
|
||||||
|
|
||||||
if (fds->revents != 0) {
|
if (fds->revents != 0) {
|
||||||
sem_post(fds->sem);
|
sem_post(fds->sem);
|
||||||
}
|
}
|
||||||
@ -509,7 +486,6 @@ static int devsif_poll(FAR struct file *filep, FAR struct pollfd *fds,
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
int devsif_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
|
int devsif_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
|
||||||
{
|
{
|
||||||
sif_sem_wait();
|
sif_sem_wait();
|
||||||
@ -517,11 +493,9 @@ int devsif_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
|
||||||
static const struct file_operations devsif_fops = {
|
static const struct file_operations devsif_fops = {
|
||||||
devsif_open, /* open */
|
devsif_open, /* open */
|
||||||
@ -535,43 +509,41 @@ static const struct file_operations devsif_fops = {
|
|||||||
#endif
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/** Bring up the Sensor Interface by initializing all of the desired
|
||||||
/** Bring up the Sensor Interface by initializing all of the desired
|
|
||||||
* hardware components.
|
* hardware components.
|
||||||
**/
|
**/
|
||||||
|
|
||||||
int sif_init(void)
|
int sif_init(void)
|
||||||
{
|
{
|
||||||
/* Initialize data-structure */
|
/* Initialize data-structure */
|
||||||
|
|
||||||
vsn_sif.state = VSN_SIF_STATE_POWERDOWN;
|
vsn_sif.state = VSN_SIF_STATE_POWERDOWN;
|
||||||
vsn_sif.opencnt = 0;
|
vsn_sif.opencnt = 0;
|
||||||
sem_init(&vsn_sif.exclusive_access, 0, 1);
|
sem_init(&vsn_sif.exclusive_access, 0, 1);
|
||||||
|
|
||||||
/* Initialize hardware */
|
/* Initialize hardware */
|
||||||
|
|
||||||
sif_gpios_reset();
|
sif_gpios_reset();
|
||||||
if ( sif_anout_init() != OK ) return -1;
|
if (sif_anout_init() != OK) return -1;
|
||||||
if ( sif_anin_reset() != OK ) return -1;
|
if (sif_anin_reset() != OK) return -1;
|
||||||
|
|
||||||
/* If everything is okay, register the driver */
|
/* If everything is okay, register the driver */
|
||||||
|
|
||||||
(void)register_driver("/dev/sif0", &devsif_fops, 0666, NULL);
|
(void)register_driver("/dev/sif0", &devsif_fops, 0666, NULL);
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/** SIF Utility
|
/** SIF Utility
|
||||||
*
|
*
|
||||||
* Provides direct access to the sensor connector, readings, and diagnostic.
|
* Provides direct access to the sensor connector, readings, and diagnostic.
|
||||||
**/
|
**/
|
||||||
|
|
||||||
extern int cc1101_eventcb(int irq, FAR void *context);
|
extern int cc1101_eventcb(int irq, FAR void *context);
|
||||||
|
|
||||||
int sif_main(int argc, char *argv[])
|
int sif_main(int argc, char *argv[])
|
||||||
{
|
{
|
||||||
if (argc >= 2) {
|
if (argc >= 2) {
|
||||||
if (!strcmp(argv[1], "init")) {
|
if (!strcmp(argv[1], "init")) {
|
||||||
return sif_init();
|
return sif_init();
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "gpio") && argc == 4) {
|
else if (!strcmp(argv[1], "gpio") && argc == 4) {
|
||||||
@ -579,7 +551,7 @@ int sif_main(int argc, char *argv[])
|
|||||||
vsn_sif.gpio[1] = atoi(argv[3]);
|
vsn_sif.gpio[1] = atoi(argv[3]);
|
||||||
sif_gpio1_update();
|
sif_gpio1_update();
|
||||||
sif_gpio2_update();
|
sif_gpio2_update();
|
||||||
printf("GPIO States: %2x %2x\n", vsn_sif.gpio[0], vsn_sif.gpio[1] );
|
printf("GPIO States: %2x %2x\n", vsn_sif.gpio[0], vsn_sif.gpio[1]);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "pwr") && argc == 3) {
|
else if (!strcmp(argv[1], "pwr") && argc == 3) {
|
||||||
@ -593,12 +565,12 @@ int sif_main(int argc, char *argv[])
|
|||||||
t_set.tv_sec = atoi(argv[2]);
|
t_set.tv_sec = atoi(argv[2]);
|
||||||
clock_settime(CLOCK_REALTIME, &t_set);
|
clock_settime(CLOCK_REALTIME, &t_set);
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "free") ) {
|
else if (!strcmp(argv[1], "free")) {
|
||||||
uint16_t page = 0, stpage = 0xFFFF;
|
uint16_t page = 0, stpage = 0xFFFF;
|
||||||
int status;
|
int status;
|
||||||
do {
|
do {
|
||||||
status = up_progmem_ispageerased(page++);
|
status = up_progmem_ispageerased(page++);
|
||||||
|
|
||||||
/* Is this beginning of new free space section */
|
/* Is this beginning of new free space section */
|
||||||
if (status == 0) {
|
if (status == 0) {
|
||||||
if (stpage == 0xFFFF) stpage = page-1;
|
if (stpage == 0xFFFF) stpage = page-1;
|
||||||
@ -613,39 +585,39 @@ int sif_main(int argc, char *argv[])
|
|||||||
while (status >= 0);
|
while (status >= 0);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "erase") && argc == 3 ) {
|
else if (!strcmp(argv[1], "erase") && argc == 3) {
|
||||||
int page = atoi(argv[2]);
|
int page = atoi(argv[2]);
|
||||||
printf("Erase result: %d\n", up_progmem_erasepage(page) );
|
printf("Erase result: %d\n", up_progmem_erasepage(page));
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "flash") && argc == 3 ) {
|
else if (!strcmp(argv[1], "flash") && argc == 3) {
|
||||||
uint16_t page = atoi(argv[2]);
|
uint16_t page = atoi(argv[2]);
|
||||||
uint32_t addr = page * up_progmem_pagesize(page);
|
uint32_t addr = page * up_progmem_pagesize(page);
|
||||||
|
|
||||||
printf("Write result: %d (writing to address %xh)\n",
|
printf("Write result: %d (writing to address %xh)\n",
|
||||||
up_progmem_write( addr, "Test", 4 ), addr);
|
up_progmem_write(addr, "Test", 4), addr);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "i2c") && argc == 3) {
|
else if (!strcmp(argv[1], "i2c") && argc == 3) {
|
||||||
int val = atoi(argv[2]);
|
int val = atoi(argv[2]);
|
||||||
|
|
||||||
I2C_SETFREQUENCY(vsn_sif.i2c1, 100000);
|
I2C_SETFREQUENCY(vsn_sif.i2c1, 100000);
|
||||||
|
|
||||||
struct lis331dl_dev_s * lis = lis331dl_init(vsn_sif.i2c1, val);
|
struct lis331dl_dev_s * lis = lis331dl_init(vsn_sif.i2c1, val);
|
||||||
|
|
||||||
if (lis) {
|
if (lis) {
|
||||||
const struct lis331dl_vector_s * a;
|
const struct lis331dl_vector_s * a;
|
||||||
int i;
|
int i;
|
||||||
uint32_t time_stamp = clock_systimer();
|
uint32_t time_stamp = clock_systimer();
|
||||||
|
|
||||||
/* Set to 400 Hz : 3 = 133 Hz/axis */
|
/* Set to 400 Hz : 3 = 133 Hz/axis */
|
||||||
|
|
||||||
lis331dl_setconversion(lis, false, true);
|
lis331dl_setconversion(lis, false, true);
|
||||||
|
|
||||||
/* Sample some values */
|
/* Sample some values */
|
||||||
|
|
||||||
for (i=0; i<1000; ) {
|
for (i=0; i<1000;) {
|
||||||
if ( (a = lis331dl_getreadings(lis)) ) {
|
if ((a = lis331dl_getreadings(lis))) {
|
||||||
i++;
|
i++;
|
||||||
printf("%d %d %d\n", a->x, a->y, a->z);
|
printf("%d %d %d\n", a->x, a->y, a->z);
|
||||||
}
|
}
|
||||||
@ -654,9 +626,9 @@ int sif_main(int argc, char *argv[])
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
printf("Time diff = %d\n", clock_systimer() - time_stamp);
|
printf("Time diff = %d\n", clock_systimer() - time_stamp);
|
||||||
|
|
||||||
lis331dl_deinit(lis);
|
lis331dl_deinit(lis);
|
||||||
}
|
}
|
||||||
else printf("Exit point: errno=%d\n", errno);
|
else printf("Exit point: errno=%d\n", errno);
|
||||||
@ -665,7 +637,7 @@ int sif_main(int argc, char *argv[])
|
|||||||
}
|
}
|
||||||
else if (!strcmp(argv[1], "pga")) {
|
else if (!strcmp(argv[1], "pga")) {
|
||||||
int gain = atoi(argv[2]);
|
int gain = atoi(argv[2]);
|
||||||
|
|
||||||
gain = vsn_muxbus_setpgagain(gain);
|
gain = vsn_muxbus_setpgagain(gain);
|
||||||
|
|
||||||
printf("Gain changed: %d\n", gain);
|
printf("Gain changed: %d\n", gain);
|
||||||
@ -675,34 +647,34 @@ int sif_main(int argc, char *argv[])
|
|||||||
struct cc1101_dev_s * cc;
|
struct cc1101_dev_s * cc;
|
||||||
uint8_t buf[64];
|
uint8_t buf[64];
|
||||||
int sta;
|
int sta;
|
||||||
|
|
||||||
cc = cc1101_init(vsn_sif.spi2, CC1101_PIN_GDO0, GPIO_CC1101_GDO0,
|
cc = cc1101_init(vsn_sif.spi2, CC1101_PIN_GDO0, GPIO_CC1101_GDO0,
|
||||||
&cc1101_rfsettings_ISM1_868MHzGFSK100kbps);
|
&cc1101_rfsettings_ISM1_868MHzGFSK100kbps);
|
||||||
|
|
||||||
if (cc) {
|
if (cc) {
|
||||||
|
|
||||||
/* Work-around: enable falling edge, event and interrupt */
|
/* Work-around: enable falling edge, event and interrupt */
|
||||||
stm32_gpiosetevent(GPIO_CC1101_GDO0, false, true, true, cc1101_eventcb);
|
stm32_gpiosetevent(GPIO_CC1101_GDO0, false, true, true, cc1101_eventcb);
|
||||||
|
|
||||||
/* Enable clock to ARM PLL, allowing to speed-up to 72 MHz */
|
/* Enable clock to ARM PLL, allowing to speed-up to 72 MHz */
|
||||||
cc1101_setgdo(cc, CC1101_PIN_GDO2, CC1101_GDO_CLK_XOSC3);
|
cc1101_setgdo(cc, CC1101_PIN_GDO2, CC1101_GDO_CLK_XOSC3);
|
||||||
|
|
||||||
cc1101_setchannel(cc, 0); /* AV Test Hex, receive on that channel */
|
cc1101_setchannel(cc, 0); /* AV Test Hex, receive on that channel */
|
||||||
cc1101_receive(cc); /* Enter RX mode */
|
cc1101_receive(cc); /* Enter RX mode */
|
||||||
while (1)
|
while (1)
|
||||||
{
|
{
|
||||||
fflush(stdout);
|
fflush(stdout);
|
||||||
sta = cc1101_read(cc, buf, 64);
|
sta = cc1101_read(cc, buf, 64);
|
||||||
if (sta > 0) {
|
if (sta > 0) {
|
||||||
printf("Received %d bytes: rssi=%d [dBm], LQI=%d (CRC %s)\n",
|
printf("Received %d bytes: rssi=%d [dBm], LQI=%d (CRC %s)\n",
|
||||||
sta, cc1101_calcRSSIdBm(buf[sta-2]), buf[sta-1]&0x7F,
|
sta, cc1101_calcRSSIdBm(buf[sta-2]), buf[sta-1]&0x7F,
|
||||||
(buf[sta-1]&0x80)?"OK":"BAD");
|
(buf[sta-1]&0x80)?"OK":"BAD");
|
||||||
|
|
||||||
cc1101_write(cc, buf, 61);
|
cc1101_write(cc, buf, 61);
|
||||||
cc1101_send(cc);
|
cc1101_send(cc);
|
||||||
|
|
||||||
printf("Packet send back\n");
|
printf("Packet send back\n");
|
||||||
|
|
||||||
cc1101_receive(cc);
|
cc1101_receive(cc);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -711,12 +683,12 @@ int sif_main(int argc, char *argv[])
|
|||||||
}
|
}
|
||||||
|
|
||||||
fprintf(stderr, "%s:\tinit\n\tgpio\tA B\n\tpwr\tval\n", argv[0]);
|
fprintf(stderr, "%s:\tinit\n\tgpio\tA B\n\tpwr\tval\n", argv[0]);
|
||||||
|
|
||||||
struct timespec t_active;
|
struct timespec t_active;
|
||||||
clock_gettime(CLOCK_ACTIVETIME, &t_active);
|
clock_gettime(CLOCK_ACTIVETIME, &t_active);
|
||||||
|
|
||||||
fprintf(stderr, "rtc time = %u, active = %u / %u, time / systick = %u / %u\n",
|
fprintf(stderr, "rtc time = %u, active = %u / %u, time / systick = %u / %u\n",
|
||||||
up_rtc_time(), t_active.tv_sec, t_active.tv_nsec,
|
up_rtc_time(), t_active.tv_sec, t_active.tv_nsec,
|
||||||
time(NULL), clock_systimer() );
|
time(NULL), clock_systimer());
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
@ -653,7 +653,7 @@ static inline void rit_clear(FAR struct rit_dev_s *priv)
|
|||||||
|
|
||||||
/* Display each row */
|
/* Display each row */
|
||||||
|
|
||||||
for(row = 0; row < RIT_YRES; row++)
|
for (row = 0; row < RIT_YRES; row++)
|
||||||
{
|
{
|
||||||
/* Display a horizontal run */
|
/* Display a horizontal run */
|
||||||
|
|
||||||
@ -680,7 +680,7 @@ static inline void rit_clear(FAR struct rit_dev_s *priv)
|
|||||||
|
|
||||||
/* Display each row */
|
/* Display each row */
|
||||||
|
|
||||||
for(row = 0; row < RIT_YRES; row++)
|
for (row = 0; row < RIT_YRES; row++)
|
||||||
{
|
{
|
||||||
/* Display a horizontal run */
|
/* Display a horizontal run */
|
||||||
|
|
||||||
|
@ -286,7 +286,7 @@ static inline int nxffs_startpos(FAR struct nxffs_volume_s *volume,
|
|||||||
* compacting.
|
* compacting.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* Is there wasted space between the offset where the we could have
|
/* Is there wasted space between the offset where the we could have
|
||||||
* valid data and the offset to the beginning of the first valid
|
* valid data and the offset to the beginning of the first valid
|
||||||
|
@ -133,7 +133,7 @@ int inet_pton(int af, FAR const char *src, FAR void *dst)
|
|||||||
numoffset = 0;
|
numoffset = 0;
|
||||||
ndots = 0;
|
ndots = 0;
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
ch = (uint8_t)src[srcoffset++];
|
ch = (uint8_t)src[srcoffset++];
|
||||||
|
|
||||||
@ -231,7 +231,7 @@ int inet_pton(int af, FAR const char *src, FAR void *dst)
|
|||||||
nrsep = 0;
|
nrsep = 0;
|
||||||
rtime = false;
|
rtime = false;
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
ch = (uint8_t)src[srcoffset++];
|
ch = (uint8_t)src[srcoffset++];
|
||||||
|
|
||||||
|
@ -66,7 +66,7 @@ void sq_rem(FAR sq_entry_t *node, sq_queue_t *queue)
|
|||||||
else
|
else
|
||||||
{
|
{
|
||||||
FAR sq_entry_t *prev;
|
FAR sq_entry_t *prev;
|
||||||
for(prev = (FAR sq_entry_t*)queue->head;
|
for (prev = (FAR sq_entry_t*)queue->head;
|
||||||
prev && prev->flink != node;
|
prev && prev->flink != node;
|
||||||
prev = prev->flink);
|
prev = prev->flink);
|
||||||
|
|
||||||
|
@ -65,7 +65,7 @@ FAR sq_entry_t *sq_remlast(sq_queue_t *queue)
|
|||||||
else
|
else
|
||||||
{
|
{
|
||||||
FAR sq_entry_t *prev;
|
FAR sq_entry_t *prev;
|
||||||
for(prev = queue->head;
|
for (prev = queue->head;
|
||||||
prev && prev->flink != ret;
|
prev && prev->flink != ret;
|
||||||
prev = prev->flink);
|
prev = prev->flink);
|
||||||
|
|
||||||
|
@ -177,7 +177,7 @@ FAR char *lib_fgets(FAR char *buf, size_t buflen, FILE *stream,
|
|||||||
* the next character and one for the null terminator.
|
* the next character and one for the null terminator.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* Get the next character */
|
/* Get the next character */
|
||||||
|
|
||||||
|
@ -58,7 +58,7 @@ void uip_neighbor_init(void)
|
|||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for(i = 0; i < ENTRIES; ++i)
|
for (i = 0; i < ENTRIES; ++i)
|
||||||
{
|
{
|
||||||
entries[i].time = MAX_TIME;
|
entries[i].time = MAX_TIME;
|
||||||
}
|
}
|
||||||
@ -68,7 +68,7 @@ void uip_neighbor_periodic(void)
|
|||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for(i = 0; i < ENTRIES; ++i)
|
for (i = 0; i < ENTRIES; ++i)
|
||||||
{
|
{
|
||||||
if (entries[i].time < MAX_TIME)
|
if (entries[i].time < MAX_TIME)
|
||||||
{
|
{
|
||||||
@ -125,7 +125,7 @@ static struct neighbor_entry *find_entry(uip_ipaddr_t ipaddr)
|
|||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for(i = 0; i < ENTRIES; ++i)
|
for (i = 0; i < ENTRIES; ++i)
|
||||||
{
|
{
|
||||||
if (uip_ipaddr_cmp(entries[i].ipaddr, ipaddr))
|
if (uip_ipaddr_cmp(entries[i].ipaddr, ipaddr))
|
||||||
{
|
{
|
||||||
|
@ -220,9 +220,9 @@ static FAR sigpendq_t *sig_findpendingsignal(FAR struct task_group_s *group,
|
|||||||
|
|
||||||
/* Seach the list for a sigpendion on this signal */
|
/* Seach the list for a sigpendion on this signal */
|
||||||
|
|
||||||
for(sigpend = (FAR sigpendq_t*)group->sigpendingq.head;
|
for (sigpend = (FAR sigpendq_t*)group->sigpendingq.head;
|
||||||
(sigpend && sigpend->info.si_signo != signo);
|
(sigpend && sigpend->info.si_signo != signo);
|
||||||
sigpend = sigpend->flink);
|
sigpend = sigpend->flink);
|
||||||
|
|
||||||
irqrestore(saved_state);
|
irqrestore(saved_state);
|
||||||
return sigpend;
|
return sigpend;
|
||||||
|
@ -89,7 +89,7 @@ FAR sigactq_t *sig_findaction(FAR struct tcb_s *stcb, int signo)
|
|||||||
|
|
||||||
/* Seach the list for a sigaction on this signal */
|
/* Seach the list for a sigaction on this signal */
|
||||||
|
|
||||||
for(sigact = (FAR sigactq_t*)stcb->sigactionq.head;
|
for (sigact = (FAR sigactq_t*)stcb->sigactionq.head;
|
||||||
((sigact) && (sigact->signo != signo));
|
((sigact) && (sigact->signo != signo));
|
||||||
sigact = sigact->flink);
|
sigact = sigact->flink);
|
||||||
|
|
||||||
|
@ -690,7 +690,7 @@ static char *read_line(FILE *stream)
|
|||||||
|
|
||||||
/* Loop to handle continuation lines */
|
/* Loop to handle continuation lines */
|
||||||
|
|
||||||
for(;;)
|
for (;;)
|
||||||
{
|
{
|
||||||
/* How long is the line so far? */
|
/* How long is the line so far? */
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user