deon/chopstx
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

fix col/row.

Browse Source
This commit is contained in:
NIIBE Yutaka
2014-08-04 11:23:43 +09:00
parent b05e4030d2
commit dffcf2d4bf
6 changed files with 960 additions and 48 deletions
Download Patch File Download Diff File Expand all files Collapse all files

147
example-fsm-55/hacker-emblem.c
View File

@@ -33,26 +33,27 @@ struct GPIO {
#define GPIOF ((struct GPIO *) GPIOF_BASE)
static struct GPIO *const GPIO_LED = ((struct GPIO *const) GPIO_LED_BASE);
static struct GPIO *const GPIO_OTHER = ((struct GPIO *const) GPIO_OTHER_BASE);
static chopstx_mutex_t mtx;
static chopstx_cond_t cnd0;
static chopstx_cond_t cnd1;
static uint8_t u;
static uint8_t
user_button (void)
{
return (GPIO_OTHER->IDR & 1) == 0;
}
static uint8_t l_data[5];
static void
set_led_display (uint32_t data)
{
if (data)
{
l_data[0] = l_data[1] = l_data[2] = l_data[3] = l_data[4] = 0x1f;
}
else
{
l_data[0] = l_data[1] = l_data[2] = l_data[3] = l_data[4] = 0x00;
}
l_data[0] = (data >> 0) & 0x1f;
l_data[1] = (data >> 5) & 0x1f;
l_data[2] = (data >> 10) & 0x1f;
l_data[3] = (data >> 15) & 0x1f;
l_data[4] = (data >> 20) & 0x1f;
}
@@ -63,17 +64,22 @@ wait_for (uint32_t usec)
}
static void
led_prepare_column (uint8_t data)
led_prepare_row (uint8_t col)
{
uint16_t data = 0x1f;
data |= ((l_data[0] & (1 << col)) ? 1 : 0) << 5;
data |= ((l_data[1] & (1 << col)) ? 1 : 0) << 6;
data |= ((l_data[2] & (1 << col)) ? 1 : 0) << 7;
data |= ((l_data[3] & (1 << col)) ? 1 : 0) << 9;
data |= ((l_data[4] & (1 << col)) ? 1 : 0) << 10;
GPIO_LED->ODR = data;
}
static void
led_enable_row (uint8_t row)
led_enable_column (uint8_t col)
{
static const uint8_t row_to_pin[5] = { 5, 6, 7, 9, 10 };
GPIO_LED->BSRR = (1 << row_to_pin[row]);
GPIO_LED->BRR = (1 << col);
}
static void *
@@ -91,8 +97,8 @@ led (void *arg)
for (i = 0; i < 5; i++)
{
led_prepare_column (l_data [i]);
led_enable_row (i);
led_prepare_row (i);
led_enable_column (i);
wait_for (1000);
}
}
@@ -100,65 +106,110 @@ led (void *arg)
return NULL;
}
static void *
blk (void *arg)
{
(void)arg;
chopstx_mutex_lock (&mtx);
chopstx_cond_wait (&cnd1, &mtx);
chopstx_mutex_unlock (&mtx);
while (1)
{
set_led_display (0);
wait_for (200*1000);
set_led_display (u);
wait_for (200*1000);
}
return NULL;
}
#define PRIO_LED 3
#define PRIO_BLK 2
extern uint8_t __process1_stack_base__, __process1_stack_size__;
extern uint8_t __process2_stack_base__, __process2_stack_size__;
extern uint8_t __process3_stack_base__, __process3_stack_size__;
const uint32_t __stackaddr_led = (uint32_t)&__process1_stack_base__;
const size_t __stacksize_led = (size_t)&__process1_stack_size__;
const uint32_t __stackaddr_blk = (uint32_t)&__process2_stack_base__;
const size_t __stacksize_blk = (size_t)&__process2_stack_size__;
#define DATA55(x0,x1,x2,x3,x4) (x0<<20)|(x1<<15)|(x2<<10)|(x3<< 5)|(x4<< 0)
static uint32_t l55[20] = {
DATA55 (0x08, 0x04, 0x1c, 0x00, 0x00),
DATA55 (0x00, 0x14, 0x0c, 0x08, 0x00),
DATA55 (0x00, 0x04, 0x14, 0x0c, 0x00),
DATA55 (0x00, 0x08, 0x06, 0x0c, 0x00),
DATA55 (0x00, 0x04, 0x02, 0x0e, 0x00),
DATA55 (0x00, 0x00, 0x0a, 0x06, 0x04),
DATA55 (0x00, 0x00, 0x02, 0x0a, 0x06),
DATA55 (0x00, 0x00, 0x04, 0x03, 0x06),
DATA55 (0x00, 0x00, 0x02, 0x01, 0x07),
DATA55 (0x02, 0x00, 0x00, 0x05, 0x03),
DATA55 (0x03, 0x00, 0x00, 0x01, 0x05),
DATA55 (0x03, 0x00, 0x00, 0x02, 0x11),
DATA55 (0x13, 0x00, 0x00, 0x01, 0x10),
DATA55 (0x11, 0x01, 0x00, 0x00, 0x12),
DATA55 (0x12, 0x11, 0x00, 0x00, 0x10),
DATA55 (0x18, 0x11, 0x00, 0x00, 0x01),
DATA55 (0x08, 0x19, 0x00, 0x00, 0x10),
DATA55 (0x09, 0x18, 0x10, 0x00, 0x00),
DATA55 (0x08, 0x09, 0x18, 0x00, 0x00),
DATA55 (0x10, 0x0c, 0x18, 0x00, 0x00),
};
static uint32_t gnu[30] = {
DATA55 (0x00, 0x00, 0x00, 0x00, 0x00),
DATA55 (0x00, 0x01, 0x01, 0x01, 0x00),
DATA55 (0x01, 0x02, 0x02, 0x02, 0x01),
DATA55 (0x03, 0x04, 0x04, 0x04, 0x03),
DATA55 (0x07, 0x08, 0x09, 0x08, 0x07),
DATA55 (0x0e, 0x10, 0x13, 0x11, 0x0e),
DATA55 (0x1c, 0x00, 0x06, 0x02, 0x1c),
DATA55 (0x19, 0x01, 0x0d, 0x05, 0x19),
DATA55 (0x12, 0x03, 0x1a, 0x0a, 0x12),
DATA55 (0x04, 0x06, 0x15, 0x14, 0x04),
DATA55 (0x08, 0x0c, 0x0a, 0x09, 0x08),
DATA55 (0x11, 0x19, 0x15, 0x13, 0x11),
DATA55 (0x02, 0x12, 0x0a, 0x06, 0x02),
DATA55 (0x05, 0x05, 0x15, 0x0d, 0x04),
DATA55 (0x0a, 0x0a, 0x0a, 0x1a, 0x09),
DATA55 (0x14, 0x14, 0x14, 0x14, 0x13),
DATA55 (0x08, 0x08, 0x08, 0x08, 0x07),
DATA55 (0x11, 0x11, 0x11, 0x11, 0x0e),
DATA55 (0x02, 0x02, 0x02, 0x02, 0x1c),
DATA55 (0x04, 0x04, 0x04, 0x04, 0x18),
DATA55 (0x08, 0x08, 0x08, 0x08, 0x10),
DATA55 (0x11, 0x11, 0x11, 0x10, 0x01),
DATA55 (0x03, 0x03, 0x03, 0x00, 0x02),
DATA55 (0x06, 0x06, 0x06, 0x00, 0x04),
DATA55 (0x0c, 0x0c, 0x0c, 0x00, 0x08),
DATA55 (0x18, 0x18, 0x18, 0x00, 0x10),
DATA55 (0x10, 0x10, 0x10, 0x00, 0x00),
DATA55 (0x00, 0x00, 0x00, 0x00, 0x00),
DATA55 (0x00, 0x00, 0x00, 0x00, 0x00),
DATA55 (0x00, 0x00, 0x00, 0x00, 0x00),
};
int
main (int argc, const char *argv[])
{
uint8_t state = 0;
(void)argc;
(void)argv;
chopstx_mutex_init (&mtx);
chopstx_cond_init (&cnd0);
chopstx_cond_init (&cnd1);
chopstx_create (PRIO_LED, __stackaddr_led, __stacksize_led, led, NULL);
chopstx_create (PRIO_BLK, __stackaddr_blk, __stacksize_blk, blk, NULL);
chopstx_usec_wait (200*1000);
chopstx_mutex_lock (&mtx);
chopstx_cond_signal (&cnd0);
chopstx_cond_signal (&cnd1);
chopstx_mutex_unlock (&mtx);
while (1)
{
u ^= 1;
wait_for (200*1000*6);
int i;
if (state)
for (i = 0; i < 20; i++)
{
if (user_button ())
state = 0;
set_led_display (l55[i]);
wait_for (500*1000);
}
else
for (i = 0; i < 30; i++)
{
if (user_button ())
state = 1;
set_led_display (gnu[i]);
wait_for (200*1000);
}
}
return 0;