SHOW:
|
|
- or go back to the newest paste.
1 | - | #include <display_syscalls.h> |
1 | + | #include <display_syscalls.h> |
2 | - | #include <display.h> |
2 | + | #include <display.h> |
3 | - | #include <keyboard_syscalls.h> |
3 | + | #include <keyboard_syscalls.h> |
4 | - | #include <keyboard.hpp> |
4 | + | #include <keyboard.hpp> |
5 | - | #include <math.h> |
5 | + | #include <math.h> |
6 | - | #include <color.h> |
6 | + | #include <color.h> |
7 | - | |
7 | + | |
8 | - | short unsigned int heightcolor(float z, float z_min, float z_max); |
8 | + | short unsigned int heightcolor(float z, float z_min, float z_max); |
9 | - | void fillArea(int x, int y, int width, int height, int color); |
9 | + | void fillArea(int x, int y, int width, int height, int color); |
10 | - | int PRGM_GetKey(void); |
10 | + | int PRGM_GetKey(void); |
11 | - | void plot(int x0, int y0, int color); |
11 | + | void plot(int x0, int y0, int color); |
12 | - | |
12 | + | |
13 | - | int main(void) { |
13 | + | int main(void) { |
14 | - | //program variables |
14 | + | //program variables |
15 | - | int key; |
15 | + | int key; |
16 | - | int done = 0; |
16 | + | int done = 0; |
17 | - | |
17 | + | |
18 | - | //graphing variables |
18 | + | //graphing variables |
19 | - | float start = 0; |
19 | + | float start = 0; |
20 | - | float t; |
20 | + | float t; |
21 | - | int x; |
21 | + | float x; |
22 | - | int y = 2; |
22 | + | float y = 100; |
23 | - | int h = 2; |
23 | + | int h = 2; |
24 | - | float g = -9.8; |
24 | + | float g = -9.8; |
25 | - | int vy = 0; |
25 | + | float vy = 0; |
26 | - | int vx = 100; |
26 | + | float vx = 100; |
27 | - | char buffer2[10]; |
27 | + | char buffer2[10]; |
28 | - | |
28 | + | |
29 | - | |
29 | + | |
30 | - | |
30 | + | |
31 | - | for(t=start; t < 2; t += 0.01) { |
31 | + | for(t=start; t < 2; t += 0.01) { |
32 | - | //y = h+0.5*g* t*t + vy*t; |
32 | + | //y = h+0.5*g* t*t + vy*t; |
33 | - | //x = vx*t; |
33 | + | //x = vx*t; |
34 | - | |
34 | + | |
35 | - | x = vx*t; |
35 | + | x = vx*t; |
36 | - | y += vy; |
36 | + | y += vy; |
37 | - | vy -= 9.8; |
37 | + | vy -= 9.8; |
38 | - | |
38 | + | |
39 | - | //start debug |
39 | + | //start debug |
40 | - | strcpy(buffer2," "); |
40 | + | strcpy(buffer2," "); |
41 | - | itoa(x, buffer2+2); |
41 | + | itoa(x, buffer2+2); |
42 | - | PrintXY(3, 1, buffer2, TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
42 | + | PrintXY(3, 1, buffer2, TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
43 | - | |
43 | + | |
44 | - | strcpy(buffer2," "); |
44 | + | strcpy(buffer2," "); |
45 | - | itoa(x, buffer2+2); |
45 | + | itoa(x, buffer2+2); |
46 | - | PrintXY(3, 2, buffer2, TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
46 | + | PrintXY(3, 2, buffer2, TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
47 | - | |
47 | + | |
48 | - | PrintXY(1, 1, " X", TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
48 | + | PrintXY(1, 1, " X", TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
49 | - | PrintXY(1, 2, " Y", TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
49 | + | PrintXY(1, 2, " Y", TEXT_MODE_NORMAL, TEXT_COLOR_BLACK); |
50 | - | //end debug |
50 | + | //end debug |
51 | - | |
51 | + | |
52 | - | plot(x, LCD_HEIGHT_PX - y, COLOR_BLACK); |
52 | + | plot(x, LCD_HEIGHT_PX - y, COLOR_BLACK); |
53 | - | Bdisp_PutDisp_DD(); |
53 | + | Bdisp_PutDisp_DD(); |
54 | - | } |
54 | + | } |
55 | - | |
55 | + | |
56 | - | |
56 | + | |
57 | - | |
57 | + | |
58 | - | while(!done) { |
58 | + | while(!done) { |
59 | - | key = PRGM_GetKey(); |
59 | + | key = PRGM_GetKey(); |
60 | - | |
60 | + | |
61 | - | switch(key) { |
61 | + | switch(key) { |
62 | - | case KEY_PRGM_MENU: |
62 | + | case KEY_PRGM_MENU: |
63 | - | done = 1; |
63 | + | done = 1; |
64 | - | break; |
64 | + | break; |
65 | - | } |
65 | + | } |
66 | - | } |
66 | + | } |
67 | - | |
67 | + | |
68 | - | return 1; |
68 | + | return 1; |
69 | - | } |
69 | + | } |
70 | - | |
70 | + | |
71 | - | |
71 | + | |
72 | - | //routines |
72 | + | //routines |
73 | - | short unsigned int heightcolor(float z, float z_min, float z_max) { |
73 | + | short unsigned int heightcolor(float z, float z_min, float z_max) { |
74 | - | float frac = ((z-z_min)/(z_max-z_min)); |
74 | + | float frac = ((z-z_min)/(z_max-z_min)); |
75 | - | |
75 | + | |
76 | - | //color! |
76 | + | //color! |
77 | - | float r = (0.25f)-frac; |
77 | + | float r = (0.25f)-frac; |
78 | - | float g = (0.5f)-frac; |
78 | + | float g = (0.5f)-frac; |
79 | - | float b = (0.75f)-frac; |
79 | + | float b = (0.75f)-frac; |
80 | - | |
80 | + | |
81 | - | //calculate the R/G/B values |
81 | + | //calculate the R/G/B values |
82 | - | r = (r>0.f)?r:-r; g = (g>0.f)?g:-g; b = (b>0.f)?b:-b; //absolute value |
82 | + | r = (r>0.f)?r:-r; g = (g>0.f)?g:-g; b = (b>0.f)?b:-b; //absolute value |
83 | - | r = (0.25f)-r; g = (1.f/3.f)-g; b = (0.25f)-b; //invert |
83 | + | r = (0.25f)-r; g = (1.f/3.f)-g; b = (0.25f)-b; //invert |
84 | - | r = (r>0.f)?(6.f*r):0.f; g = (g>0.f)?(6.f*g):0.f; b = (b>0.f)?(6.f*b):0.f; //scale the chromatic triangles |
84 | + | r = (r>0.f)?(6.f*r):0.f; g = (g>0.f)?(6.f*g):0.f; b = (b>0.f)?(6.f*b):0.f; //scale the chromatic triangles |
85 | - | r = (r>1.f)?1.f:r; g = (g>1.f)?1.f:g; b = (b>1.f)?1.f:b; //clip the top of the chromatic triangles |
85 | + | r = (r>1.f)?1.f:r; g = (g>1.f)?1.f:g; b = (b>1.f)?1.f:b; //clip the top of the chromatic triangles |
86 | - | if (frac < 0.25f) r = (r+1.f)/2.f; //adjust the bottom end of the scale so that z_min is red, not black |
86 | + | if (frac < 0.25f) r = (r+1.f)/2.f; //adjust the bottom end of the scale so that z_min is red, not black |
87 | - | if (frac > 0.75f) b = (b+1.f)/2.f; //adjust the top end of the scale so that z_max is blue, not black |
87 | + | if (frac > 0.75f) b = (b+1.f)/2.f; //adjust the top end of the scale so that z_max is blue, not black |
88 | - | return (short unsigned int)(0x0000ffff & (((int)(31.f*r) << 11) | ((int)(63.f*g) << 5) | ((int)(31.f*b)))); //put the bits together |
88 | + | return (short unsigned int)(0x0000ffff & (((int)(31.f*r) << 11) | ((int)(63.f*g) << 5) | ((int)(31.f*b)))); //put the bits together |
89 | - | } |
89 | + | } |
90 | - | |
90 | + | |
91 | - | void fillArea(int x, int y, int width, int height, int color) { |
91 | + | void fillArea(int x, int y, int width, int height, int color) { |
92 | - | //only use lower two bytes of color |
92 | + | //only use lower two bytes of color |
93 | - | char* VRAM = (char*)0xA8000000; |
93 | + | char* VRAM = (char*)0xA8000000; |
94 | - | VRAM += 2*(LCD_WIDTH_PX*y + x); |
94 | + | VRAM += 2*(LCD_WIDTH_PX*y + x); |
95 | - | for(int j=y; j<y+height; j++) { |
95 | + | for(int j=y; j<y+height; j++) { |
96 | - | for(int i=x; i<x+width; i++) { |
96 | + | for(int i=x; i<x+width; i++) { |
97 | - | *(VRAM++) = (color&0x0000FF00)>>8; |
97 | + | *(VRAM++) = (color&0x0000FF00)>>8; |
98 | - | *(VRAM++) = (color&0x000000FF); |
98 | + | *(VRAM++) = (color&0x000000FF); |
99 | - | } |
99 | + | } |
100 | - | VRAM += 2*(LCD_WIDTH_PX-width); |
100 | + | VRAM += 2*(LCD_WIDTH_PX-width); |
101 | - | } |
101 | + | } |
102 | - | } |
102 | + | } |
103 | - | |
103 | + | |
104 | - | int PRGM_GetKey(void) { |
104 | + | int PRGM_GetKey(void) { |
105 | - | unsigned char buffer[12]; |
105 | + | unsigned char buffer[12]; |
106 | - | PRGM_GetKey_OS( buffer ); |
106 | + | PRGM_GetKey_OS( buffer ); |
107 | - | return ( buffer[1] & 0x0F ) * 10 + ( ( buffer[2] & 0xF0 ) >> 4 ); |
107 | + | return ( buffer[1] & 0x0F ) * 10 + ( ( buffer[2] & 0xF0 ) >> 4 ); |
108 | - | } |
108 | + | } |
109 | - | |
109 | + | |
110 | - | void plot(int x0, int y0, int color) { |
110 | + | void plot(int x0, int y0, int color) { |
111 | - | char* VRAM = (char*)0xA8000000; |
111 | + | char* VRAM = (char*)0xA8000000; |
112 | - | VRAM += 2*(y0*LCD_WIDTH_PX + x0); |
112 | + | VRAM += 2*(y0*LCD_WIDTH_PX + x0); |
113 | - | *(VRAM++) = (color&0x0000FF00)>>8; |
113 | + | *(VRAM++) = (color&0x0000FF00)>>8; |
114 | - | *(VRAM++) = (color&0x000000FF); |
114 | + | *(VRAM++) = (color&0x000000FF); |
115 | - | return; |
115 | + | return; |
116 | - | } |
116 | + | } |
117 | - | |
117 | + | |
118 | //my routines |