1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
|
#include "spin.h"
#include "delay.h"
#include "gpio.h"
#define SHORT_DELAY 200000
#define LONG_DELAY (SHORT_DELAY * 2)
static void flash_bit(
uint32_t base, gpio_output_pin_t out_pin,
uint8_t bit /* 0 => 0, non-zero => 1 */)
{
pin_on(out_pin);
if (bit) {
delay(base * 2);
} else {
delay(base);
}
pin_off(out_pin);
delay(base);
}
void spin(uint32_t base, uint8_t c)
{
uint8_t code;
__IO gpio_port_t* port_b = enable_gpio(GPIO_PORT_B);
gpio_output_pin_t pin3 = set_gpio_pin_output(port_b, PIN_3);
for (;;) {
code = c;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
code <<= 1;
flash_bit(base, pin3, code & 0x80);
delay(base * 4);
}
}
|