Martin Deng / Mbed 2 deprecated mbed_shapedriver

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

shape_drawer.cpp@6:baece3338bfe, 2015-05-01 (annotated)

Committer:
martydd3
Date:
Fri May 01 06:46:08 2015 +0000
Revision:
6:baece3338bfe
Parent:
5:495d64d8934d
Child:
7:2db895370298
May 1 product;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
martydd3 4:75498bd2e742 1 #include "constants.h"
martydd3 5:495d64d8934d 2 #include "mbed.h"
martydd3 5:495d64d8934d 3 #include <math.h>
martydd3 5:495d64d8934d 4
martydd3 5:495d64d8934d 5 static char work_buffer[SLICES][WIDTH];
martydd3 6:baece3338bfe 6 static int (*height)(float d) = NULL;
martydd3 5:495d64d8934d 7
martydd3 5:495d64d8934d 8 static void erase(){
martydd3 5:495d64d8934d 9 for(int i = 0; i < SLICES; i++){
martydd3 5:495d64d8934d 10 for(int j = 0; j < WIDTH; j++){
martydd3 5:495d64d8934d 11 work_buffer[i][j] = 0x00;
martydd3 5:495d64d8934d 12 }
martydd3 5:495d64d8934d 13 }
martydd3 5:495d64d8934d 14 }
martydd3 5:495d64d8934d 15
martydd3 6:baece3338bfe 16 void draw_point(float x1, float y1, float z1, float x2, float y2, float z2, float r){
martydd3 6:baece3338bfe 17
martydd3 5:495d64d8934d 18 }
martydd3 5:495d64d8934d 19
martydd3 6:baece3338bfe 20 void draw_circle(float r, float _h){
martydd3 5:495d64d8934d 21 for(int i = 0; i < SLICES; i++){
martydd3 6:baece3338bfe 22 float h;
martydd3 6:baece3338bfe 23
martydd3 6:baece3338bfe 24 if(height != NULL)
martydd3 6:baece3338bfe 25 h = height(1.0 * i / SLICES);
martydd3 6:baece3338bfe 26 else
martydd3 6:baece3338bfe 27 h = _h;
martydd3 6:baece3338bfe 28
martydd3 6:baece3338bfe 29 work_buffer[i][(int)rint(r)] |= (0x01 << (int)rint(h));
martydd3 6:baece3338bfe 30 }
martydd3 5:495d64d8934d 31 }
martydd3 5:495d64d8934d 32
martydd3 5:495d64d8934d 33 #define VERT 1
martydd3 5:495d64d8934d 34 #define HORZ 0
martydd3 5:495d64d8934d 35
martydd3 5:495d64d8934d 36 static void draw_zvert_line(float x, float y, float z1, float z2);
martydd3 5:495d64d8934d 37 static void draw_orig_line(float x1, float x2, float z1, float z2, int ori);
martydd3 5:495d64d8934d 38 static void draw_perp_line(float a1, float a2, float b, float z1, float z2, int ori);
martydd3 5:495d64d8934d 39 static void draw_arb_line(float x1, float x2, float y1, float y2, float z1, float z2);
martydd3 5:495d64d8934d 40
martydd3 5:495d64d8934d 41 static void norm_angle(float &p){
martydd3 5:495d64d8934d 42 p = p < 0 ? p + 2 * M_PI : p;
martydd3 5:495d64d8934d 43 p = p > 2 * M_PI ? p - 2 * M_PI : p;
martydd3 5:495d64d8934d 44 }
martydd3 5:495d64d8934d 45
martydd3 5:495d64d8934d 46 static float deg2rad(float p){
martydd3 5:495d64d8934d 47 return 2 * M_PI * p / SLICES;
martydd3 5:495d64d8934d 48 }
martydd3 5:495d64d8934d 49
martydd3 5:495d64d8934d 50 static float rad2deg(float p){
martydd3 5:495d64d8934d 51 return p * SLICES / (2 * M_PI);
martydd3 5:495d64d8934d 52 }
martydd3 5:495d64d8934d 53
martydd3 5:495d64d8934d 54 static void step_i(float a, float b, int &i){
martydd3 5:495d64d8934d 55 float diff = abs(a - b);
martydd3 5:495d64d8934d 56 if(diff > SLICES / 2)
martydd3 5:495d64d8934d 57 i = a > b ? i + 1: i - 1;
martydd3 5:495d64d8934d 58 else
martydd3 5:495d64d8934d 59 i = a > b ? i - 1: i + 1;
martydd3 5:495d64d8934d 60
martydd3 5:495d64d8934d 61 i = (i == SLICES) ? 0 : i;
martydd3 5:495d64d8934d 62 i = (i == -1) ? SLICES - 1 : i;
martydd3 5:495d64d8934d 63 }
martydd3 5:495d64d8934d 64
martydd3 6:baece3338bfe 65 void set_hfunc(int (*h)(float d)){
martydd3 6:baece3338bfe 66 height = h;
martydd3 6:baece3338bfe 67 }
martydd3 6:baece3338bfe 68
martydd3 5:495d64d8934d 69 void draw_line(float x1, float y1, float z1, float x2, float y2, float z2){
martydd3 5:495d64d8934d 70
martydd3 5:495d64d8934d 71 //Perfectly vertical depth lines
martydd3 5:495d64d8934d 72 if(x1 == x2 && y1 == y2){
martydd3 5:495d64d8934d 73 draw_zvert_line(x1, y1, z1, z2);
martydd3 5:495d64d8934d 74 }
martydd3 5:495d64d8934d 75
martydd3 5:495d64d8934d 76 //Perfectly horizontal lines through origin
martydd3 5:495d64d8934d 77 else if(y1 == 0 && y2 == 0){
martydd3 5:495d64d8934d 78 draw_orig_line(x1, x2, z1, z2, HORZ);
martydd3 5:495d64d8934d 79 }
martydd3 5:495d64d8934d 80
martydd3 5:495d64d8934d 81 //Perfectly vertical lines through origin
martydd3 5:495d64d8934d 82 else if(x1 == 0 && x2 == 0){
martydd3 5:495d64d8934d 83 draw_orig_line(y1, y2, z1, z2, VERT);
martydd3 5:495d64d8934d 84 }
martydd3 5:495d64d8934d 85
martydd3 5:495d64d8934d 86 //Perfectly horizontal lines
martydd3 5:495d64d8934d 87 else if(y1 == y2){
martydd3 5:495d64d8934d 88 draw_perp_line(x1, x2, y1, z1, z2, HORZ);
martydd3 5:495d64d8934d 89 }
martydd3 5:495d64d8934d 90
martydd3 5:495d64d8934d 91 //Perfectly vertical lines
martydd3 5:495d64d8934d 92 // r = b / r cos p
martydd3 5:495d64d8934d 93 else if(x1 == x2){
martydd3 5:495d64d8934d 94 draw_perp_line(y1, y2, x1, z1, z2, VERT);
martydd3 5:495d64d8934d 95 }
martydd3 5:495d64d8934d 96
martydd3 5:495d64d8934d 97 //Arbitrary lines
martydd3 5:495d64d8934d 98 else {
martydd3 5:495d64d8934d 99 draw_arb_line(x1, x2, y1, y2, z1, z2);
martydd3 5:495d64d8934d 100 }
martydd3 5:495d64d8934d 101 }
martydd3 4:75498bd2e742 102
martydd3 5:495d64d8934d 103 static void draw_arb_line(float x1, float x2, float y1, float y2, float z1, float z2){
martydd3 5:495d64d8934d 104 // y = mx + b,
martydd3 5:495d64d8934d 105 // r = b / (sin p - m cos p)
martydd3 5:495d64d8934d 106 //
martydd3 5:495d64d8934d 107 // if m is close to infinity, better to use
martydd3 5:495d64d8934d 108 // x = ny + c
martydd3 5:495d64d8934d 109 // r = c / (cos p - n sin p)
martydd3 5:495d64d8934d 110
martydd3 5:495d64d8934d 111 float m_1 = 1.0*(y2 - y1)/(x2 - x1);
martydd3 5:495d64d8934d 112 float m_2 = 1.0*(x2 - x1)/(y2 - y1);
martydd3 5:495d64d8934d 113 float d = sqrt((x2 - x1)*(x2 - x1) + (y2 - y1)*(y2 - y1));
martydd3 6:baece3338bfe 114 float slope = (z2 - z1) / d;
martydd3 5:495d64d8934d 115 float m, p1, p2, b, h;
martydd3 5:495d64d8934d 116 int ori;
martydd3 5:495d64d8934d 117
martydd3 5:495d64d8934d 118 //x = m_2 y + b is steeper than y = m_1 x + b
martydd3 5:495d64d8934d 119 if(abs(m_2) > abs(m_1)){
martydd3 5:495d64d8934d 120 m = m_1;
martydd3 5:495d64d8934d 121 b = y1 - m * x1;
martydd3 5:495d64d8934d 122 ori = HORZ;
martydd3 5:495d64d8934d 123 } else {
martydd3 5:495d64d8934d 124 m = m_2;
martydd3 5:495d64d8934d 125 b = x1 - m * y1;
martydd3 5:495d64d8934d 126 ori = VERT;
martydd3 5:495d64d8934d 127 }
martydd3 5:495d64d8934d 128
martydd3 5:495d64d8934d 129 p1 = atan2(y1, x1);
martydd3 5:495d64d8934d 130 p2 = atan2(y2, x2);
martydd3 5:495d64d8934d 131
martydd3 5:495d64d8934d 132 norm_angle(p1);
martydd3 5:495d64d8934d 133 norm_angle(p2);
martydd3 5:495d64d8934d 134
martydd3 5:495d64d8934d 135 int i1 = rad2deg(p1);
martydd3 5:495d64d8934d 136 int i2 = rad2deg(p2);
martydd3 5:495d64d8934d 137
martydd3 5:495d64d8934d 138 while(true){
martydd3 5:495d64d8934d 139 float p = deg2rad(i1);
martydd3 5:495d64d8934d 140 float r = (ori == HORZ) ? b / (sin(p) - m * cos(p)) : b / (cos(p) - m * sin(p));
martydd3 5:495d64d8934d 141
martydd3 5:495d64d8934d 142 float dx = r * cos(p);
martydd3 5:495d64d8934d 143 float dy = r * sin(p);
martydd3 5:495d64d8934d 144
martydd3 5:495d64d8934d 145 float dd = sqrt((x1 - dx)*(x1 - dx) + (y1 - dy)*(y1 - dy));
martydd3 6:baece3338bfe 146
martydd3 6:baece3338bfe 147 if(height != NULL)
martydd3 6:baece3338bfe 148 h = height(dd / d);
martydd3 6:baece3338bfe 149 else
martydd3 6:baece3338bfe 150 h = z1 + slope * d;
martydd3 5:495d64d8934d 151
martydd3 5:495d64d8934d 152 if((int)rint(r) < WIDTH)
martydd3 5:495d64d8934d 153 work_buffer[i1][(int)rint(r)] |= (0x01 << (int)rint(h));
martydd3 5:495d64d8934d 154
martydd3 5:495d64d8934d 155 if(i1 == i2)
martydd3 5:495d64d8934d 156 break;
martydd3 5:495d64d8934d 157
martydd3 5:495d64d8934d 158 step_i(i1, i2, i1);
martydd3 5:495d64d8934d 159 }
martydd3 5:495d64d8934d 160 }
martydd3 5:495d64d8934d 161
martydd3 5:495d64d8934d 162 static void draw_perp_line(float a1, float a2, float b, float z1, float z2, int ori){
martydd3 5:495d64d8934d 163 float p1 = (ori == HORZ) ? atan2(b, a1) : atan2(a1, b);
martydd3 5:495d64d8934d 164 float p2 = (ori == HORZ) ? atan2(b, a2) : atan2(a2, b);
martydd3 5:495d64d8934d 165
martydd3 5:495d64d8934d 166 norm_angle(p1);
martydd3 5:495d64d8934d 167 norm_angle(p2);
martydd3 5:495d64d8934d 168
martydd3 5:495d64d8934d 169 int i1 = rad2deg(p1);
martydd3 5:495d64d8934d 170 int i2 = rad2deg(p2);
martydd3 5:495d64d8934d 171
martydd3 5:495d64d8934d 172 float m = (z2 - z1)/(a2 - a1);
martydd3 5:495d64d8934d 173
martydd3 5:495d64d8934d 174 while(true){
martydd3 5:495d64d8934d 175 float p = deg2rad(i1);
martydd3 5:495d64d8934d 176 float r = (ori == HORZ) ? b / sin(p) : b / cos(p);
martydd3 5:495d64d8934d 177 float d = (ori == HORZ) ? b / tan(p) : b * tan(p);
martydd3 6:baece3338bfe 178 float h;
martydd3 6:baece3338bfe 179
martydd3 6:baece3338bfe 180 if(height != NULL)
martydd3 6:baece3338bfe 181 h = height(d / (a2 - a1));
martydd3 6:baece3338bfe 182 else
martydd3 6:baece3338bfe 183 h = z1 + m * (d - a1);
martydd3 5:495d64d8934d 184
martydd3 5:495d64d8934d 185 if((int)rint(r) < WIDTH)
martydd3 5:495d64d8934d 186 work_buffer[i1][(int)rint(r)] |= (0x01 << (int)rint(h));
martydd3 5:495d64d8934d 187
martydd3 5:495d64d8934d 188 if(i1 == i2)
martydd3 5:495d64d8934d 189 break;
martydd3 5:495d64d8934d 190
martydd3 5:495d64d8934d 191 step_i(i1, i2, i1);
martydd3 5:495d64d8934d 192 }
martydd3 5:495d64d8934d 193 }
martydd3 5:495d64d8934d 194
martydd3 5:495d64d8934d 195 static void draw_orig_line(float r1, float r2, float z1, float z2, int ori){
martydd3 5:495d64d8934d 196 int p1, p2;
martydd3 5:495d64d8934d 197 float m;
martydd3 5:495d64d8934d 198
martydd3 5:495d64d8934d 199 if(ori == HORZ){
martydd3 5:495d64d8934d 200 p1 = 0;
martydd3 5:495d64d8934d 201 p2 = SLICES / 2 - 1;
martydd3 5:495d64d8934d 202 m = (1.0*z2 - 1.0*z1)/(1.0*r2 - 1.0*r1);
martydd3 5:495d64d8934d 203 } else {
martydd3 5:495d64d8934d 204 p1 = SLICES / 4 - 1;
martydd3 5:495d64d8934d 205 p2 = 3 * SLICES / 4 - 1;
martydd3 5:495d64d8934d 206 m = (1.0*z2 - 1.0*z1)/(1.0*r2 - 1.0*r1);
martydd3 5:495d64d8934d 207 }
martydd3 5:495d64d8934d 208
martydd3 5:495d64d8934d 209 int i = r1;
martydd3 5:495d64d8934d 210 while(true){
martydd3 6:baece3338bfe 211 float h;
martydd3 6:baece3338bfe 212
martydd3 6:baece3338bfe 213 if(height != NULL)
martydd3 6:baece3338bfe 214 h = height(i / (r2 - r1));
martydd3 6:baece3338bfe 215 else
martydd3 6:baece3338bfe 216 h = z1 + m * (i - r1);
martydd3 5:495d64d8934d 217
martydd3 5:495d64d8934d 218 if(i >= 0){
martydd3 5:495d64d8934d 219 work_buffer[p1][i] |= (0x01 << (int)rint(h));
martydd3 5:495d64d8934d 220 } else if(i <= 0){
martydd3 5:495d64d8934d 221 work_buffer[p2][-i] |= (0x01 << (int)rint(h));
martydd3 5:495d64d8934d 222 }
martydd3 5:495d64d8934d 223
martydd3 5:495d64d8934d 224 if(i == r2)
martydd3 5:495d64d8934d 225 break;
martydd3 5:495d64d8934d 226
martydd3 5:495d64d8934d 227 printf("i: %d, h: %d\n", i, (int)rint(h));
martydd3 5:495d64d8934d 228
martydd3 5:495d64d8934d 229 i = r1 > r2 ? i - 1 : i + 1;
martydd3 5:495d64d8934d 230 }
martydd3 5:495d64d8934d 231 }
martydd3 5:495d64d8934d 232
martydd3 5:495d64d8934d 233 static void draw_zvert_line(float x, float y, float z1, float z2){
martydd3 5:495d64d8934d 234 float r = sqrt(1.0*x*x + 1.0*y*y);
martydd3 5:495d64d8934d 235 float p = atan2(y, x);
martydd3 5:495d64d8934d 236
martydd3 5:495d64d8934d 237 //set p to 0 - 2p range, and convert to slice index
martydd3 5:495d64d8934d 238 norm_angle(p);
martydd3 5:495d64d8934d 239 p = rad2deg(p);
martydd3 5:495d64d8934d 240
martydd3 5:495d64d8934d 241 int i = z1;
martydd3 5:495d64d8934d 242 while(true){
martydd3 5:495d64d8934d 243 work_buffer[(int)rint(p)][(int)rint(r)] |= (0x01 << i);
martydd3 5:495d64d8934d 244
martydd3 5:495d64d8934d 245 if(i == z2)
martydd3 5:495d64d8934d 246 break;
martydd3 5:495d64d8934d 247
martydd3 5:495d64d8934d 248 step_i(z1, z2, i);
martydd3 5:495d64d8934d 249 }
martydd3 5:495d64d8934d 250 }
martydd3 5:495d64d8934d 251
martydd3 5:495d64d8934d 252 /*
martydd3 5:495d64d8934d 253 Moves shapes in work_buffer over to display_buffer in a format that accounts for
martydd3 5:495d64d8934d 254 displaced blades on display
martydd3 5:495d64d8934d 255 */
martydd3 5:495d64d8934d 256 static void init_displacements();
martydd3 5:495d64d8934d 257 static int displacements[HEIGHT];
martydd3 5:495d64d8934d 258
martydd3 5:495d64d8934d 259 void move_buffer(char (*buffer)[SLICES][WIDTH]){
martydd3 5:495d64d8934d 260 static bool initialized = false;
martydd3 5:495d64d8934d 261
martydd3 5:495d64d8934d 262 if(!initialized){
martydd3 5:495d64d8934d 263 init_displacements();
martydd3 5:495d64d8934d 264 }
martydd3 5:495d64d8934d 265
martydd3 5:495d64d8934d 266 for(int i = 0; i < SLICES; i++){
martydd3 5:495d64d8934d 267 for(int j = 0; j < WIDTH; j++){
martydd3 5:495d64d8934d 268 char bit = 0x00;
martydd3 5:495d64d8934d 269
martydd3 5:495d64d8934d 270 for(int h = 0; h < HEIGHT; h++){
martydd3 5:495d64d8934d 271 bit |= (work_buffer[(i + displacements[h]) % SLICES][j] & (0x01 << h));
martydd3 5:495d64d8934d 272 }
martydd3 5:495d64d8934d 273
martydd3 5:495d64d8934d 274 (*buffer)[i][j] = bit;
martydd3 5:495d64d8934d 275 }
martydd3 5:495d64d8934d 276 }
martydd3 5:495d64d8934d 277
martydd3 5:495d64d8934d 278 erase();
martydd3 5:495d64d8934d 279 }
martydd3 5:495d64d8934d 280
martydd3 5:495d64d8934d 281 /*
martydd3 5:495d64d8934d 282 Initializes buffer used to adjust for vertical misalignment of display blades
martydd3 5:495d64d8934d 283 */
martydd3 5:495d64d8934d 284 static void init_displacements(){
martydd3 5:495d64d8934d 285
martydd3 5:495d64d8934d 286 for(int i = 0; i < HEIGHT; i++){
martydd3 5:495d64d8934d 287 switch(i){
martydd3 5:495d64d8934d 288 case 0: displacements[i] = 0; break;
martydd3 5:495d64d8934d 289 case 1: displacements[i] = 4 * SLICES / 8; break;
martydd3 5:495d64d8934d 290 case 2: displacements[i] = 7 * SLICES / 8 - 5; break;
martydd3 5:495d64d8934d 291 case 3: displacements[i] = 3 * SLICES / 8 - 8; break;
martydd3 5:495d64d8934d 292 case 4: displacements[i] = 6 * SLICES / 8 - 6; break;
martydd3 5:495d64d8934d 293 case 5: displacements[i] = 2 * SLICES / 8 - 7; break;
martydd3 5:495d64d8934d 294 case 6: displacements[i] = 5 * SLICES / 8 - 7; break;
martydd3 5:495d64d8934d 295 case 7: displacements[i] = 1 * SLICES / 8 - 8; break;
martydd3 5:495d64d8934d 296 }
martydd3 5:495d64d8934d 297 }
martydd3 5:495d64d8934d 298 }
martydd3 5:495d64d8934d 299
martydd3 5:495d64d8934d 300
martydd3 5:495d64d8934d 301