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
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
#include <setjmp.h>
#include <cpu.h>
#include <globals.h>
#include <graphics/lfb.h>
#include <symbols.h>
#include <sys/schedule.h>
#include <usr/cxx.h>
#include <usr/math.h>
#include <usr/string.h>
#include <usr/timed.h>
#include <usr/uart.h>
static struct SysTimerInfo stime_0 = {
.tick_rate = 5000000,
.priority = 0,
.arg = 0,
.oneshot = 0,
};
static struct SysTimerInfo stime_1 = {
.tick_rate = 700000,
.priority = 0,
.arg = 0,
.oneshot = 0,
};
static struct SysTimerInfo stime_2 = {
.tick_rate = 300000,
.priority = 0,
.arg = 0,
.oneshot = 0,
};
static struct SysTimerInfo stime_3 = {
.tick_rate = 10,
.priority = 0,
.arg = 0,
.oneshot = 0,
};
static struct UartInfo UART_INFO = {
.priority = 2,
};
static struct GPIOInfo gpinfo = {
.pin = (1<<16 | 1<<12),
.priority = 0,
};
void gptest(void)
{
static unsigned long count = 0;
static unsigned long long ts[4096*2+20];
sys0_64(SYS_TIME, &ts[count++]);
if (count == (4096*2+18)) {
unsubscribe_irq(GPIO_BANK_1_IRQ);
//unsubscribe_irq(SYS_TIMER_3_IRQ);
static char str[14];
char* start;
unsigned long mean=0, stdev=0, max=0, min=0xFFFFFFFF;
for (unsigned long i = 0; i < 4096; i++) {
unsigned long elapsed = ts[2*(i+2)+1]-ts[2*(i+2)];
elapsed *= 1000;
mean += elapsed;
if (elapsed > max)
max = elapsed;
if (elapsed < min)
min = elapsed;
}
mean /= 4096;
for (unsigned long i = 0; i < 4096; i++) {
unsigned long elapsed = ts[2*(i+2)+1]-ts[2*(i+2)];
elapsed *= 1000;
unsigned long term = (elapsed-mean)*(elapsed-mean)/4096;
stdev += term;
}
stdev = sqrt_rnd(stdev);
start = ulong_to_string(mean, str);
draw_string(0, 10, start);
start = ulong_to_string(stdev, str);
draw_string(0, 11, start);
start = ulong_to_string(min, str);
draw_string(0, 12, start);
start = ulong_to_string(max, str);
draw_string(0, 13, start);
}
//unsigned long gplev0 = *GPLEV0;
//draw_hex32(0, 30, gplev0);
//start = ulong_to_string(count++, str);
//draw_string(0, 31, start);
}
void test_super(void);
void main(void)
{
//subscribe_irq(UART_IRQ, handle_data, &UART_INFO);
//subscribe_irq(SYS_TIMER_0_IRQ, loopt, &stime_0);
//subscribe_irq(SYS_TIMER_1_IRQ, loopt, &stime_1);
//subscribe_irq(SYS_TIMER_2_IRQ, loopt, &stime_2);
//subscribe_irq(SYS_TIMER_3_IRQ, loopt, &stime_3);
subscribe_irq(GPIO_BANK_1_IRQ, gptest, &gpinfo);
//add_thread(loop, 0, 8);
//add_thread(consumer, 0, 3);
//add_thread(test_super, 0, 4);
//subscribe_irq(SYS_TIMER_3_IRQ, gptest, &stime_3);
cpp_demo(53);
}
|
