bamlor nuttymaisuay
Dependencies: mbed
main.cpp@6:1de63d5df56a, 2017-12-11 (annotated)
- Committer:
- jaybehandsome
- Date:
- Mon Dec 11 23:02:51 2017 +0000
- Revision:
- 6:1de63d5df56a
- Parent:
- 5:738285670edf
- Child:
- 7:61c1f10bf484
fuckinggggg
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jaybehandsome | 0:1e46c1a32764 | 1 | #include "mbed.h" |
jaybehandsome | 0:1e46c1a32764 | 2 | #include "MPU9250.h" |
jaybehandsome | 6:1de63d5df56a | 3 | #include <iostream> |
jaybehandsome | 6:1de63d5df56a | 4 | #include <string> |
jaybehandsome | 0:1e46c1a32764 | 5 | |
jaybehandsome | 0:1e46c1a32764 | 6 | |
jaybehandsome | 0:1e46c1a32764 | 7 | |
jaybehandsome | 6:1de63d5df56a | 8 | string word; |
jaybehandsome | 6:1de63d5df56a | 9 | char alphabet; |
jaybehandsome | 5:738285670edf | 10 | float x; |
jaybehandsome | 0:1e46c1a32764 | 11 | float sum = 0; |
jaybehandsome | 0:1e46c1a32764 | 12 | uint32_t sumCount = 0; |
jaybehandsome | 0:1e46c1a32764 | 13 | char buffer[14]; |
jaybehandsome | 6:1de63d5df56a | 14 | int i = 0; |
jaybehandsome | 0:1e46c1a32764 | 15 | |
jaybehandsome | 0:1e46c1a32764 | 16 | MPU9250 mpu9250; |
jaybehandsome | 0:1e46c1a32764 | 17 | |
jaybehandsome | 0:1e46c1a32764 | 18 | Timer t; |
jaybehandsome | 0:1e46c1a32764 | 19 | |
jaybehandsome | 0:1e46c1a32764 | 20 | Serial pc(PA_15, PB_7); // tx, rx |
jaybehandsome | 5:738285670edf | 21 | float v, delt_t2 = 0, count2 = 0; |
jaybehandsome | 5:738285670edf | 22 | int mode; |
jaybehandsome | 6:1de63d5df56a | 23 | int cmode; |
jaybehandsome | 5:738285670edf | 24 | Serial bam(D1,D0); |
jaybehandsome | 4:9cc307f25dc9 | 25 | BusOut B(PA_0,PA_1,PA_4,PB_0,PC_1,PC_2,PC_3), A(PC_10,PC_12,PA_13,PA_14,PC_13,PC_11,PD_2), C(PA_5,PA_6,PA_7,PC_7,PB_2,PB_1,PB_15); |
jaybehandsome | 6:1de63d5df56a | 26 | |
jaybehandsome | 6:1de63d5df56a | 27 | void Text (char text,float posA,float posB,float posC,int i ) |
jaybehandsome | 6:1de63d5df56a | 28 | { |
jaybehandsome | 6:1de63d5df56a | 29 | int n = i*60; |
jaybehandsome | 6:1de63d5df56a | 30 | if (text == ' '){ |
jaybehandsome | 6:1de63d5df56a | 31 | if (posA > 0+n && posA < 10+n) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 32 | else if(posA > 10+n && posA < 20+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 33 | else if(posA > 20+n && posA < 30+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 34 | else if(posA > 30+n && posA < 40+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 35 | else if(posA > 40+n && posA < 50+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 36 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 37 | |
jaybehandsome | 6:1de63d5df56a | 38 | if (posB > 0+n && posB < 10+n) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 39 | else if(posB > 10+n && posB < 20+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 40 | else if(posB > 20+n && posB < 30+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 41 | else if(posB > 30+n && posB < 40+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 42 | else if(posB > 40+n && posB < 50+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 43 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 44 | |
jaybehandsome | 6:1de63d5df56a | 45 | if (posC > 0+n && posC < 10+n) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 46 | else if(posC > 10+n && posC < 20+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 47 | else if(posC > 20+n && posC < 30+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 48 | else if(posC > 30+n && posC < 40+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 49 | else if(posC > 40+n && posC < 50+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 50 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 51 | } |
jaybehandsome | 6:1de63d5df56a | 52 | if (text == 'A'){ |
jaybehandsome | 6:1de63d5df56a | 53 | if (posA > 0+n && posA < 10+n) { A = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 54 | else if(posA > 10+n && posA < 20+n ) { A = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 55 | else if(posA > 20+n && posA < 30+n ) { A = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 56 | else if(posA > 30+n && posA < 40+n ) { A = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 57 | else if(posA > 40+n && posA < 50+n ) { A = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 58 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 59 | |
jaybehandsome | 6:1de63d5df56a | 60 | if (posB > 0+n && posB < 10+n) { B = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 61 | else if(posB > 10+n && posB < 20+n ) { B = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 62 | else if(posB > 20+n && posB < 30+n ) { B = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 63 | else if(posB > 30+n && posB < 40+n ) { B = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 64 | else if(posB > 40+n && posB < 50+n ) { B = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 65 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 66 | |
jaybehandsome | 6:1de63d5df56a | 67 | if (posC > 0+n && posC < 10+n) { C = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 68 | else if(posC > 10+n && posC < 20+n ) { C = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 69 | else if(posC > 20+n && posC < 30+n ) { C = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 70 | else if(posC > 30+n && posC < 40+n ) { C = 0x44; } |
jaybehandsome | 6:1de63d5df56a | 71 | else if(posC > 40+n && posC < 50+n ) { C = 0x3F; } |
jaybehandsome | 6:1de63d5df56a | 72 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 73 | } |
jaybehandsome | 6:1de63d5df56a | 74 | if (text == 'B'){ |
jaybehandsome | 6:1de63d5df56a | 75 | if (posA > 0+n && posA < 10+n) { A = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 76 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 77 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 78 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 79 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 80 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 81 | |
jaybehandsome | 6:1de63d5df56a | 82 | if (posB > 0+n && posB < 10+n) { B = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 83 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 84 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 85 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 86 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 87 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 88 | |
jaybehandsome | 6:1de63d5df56a | 89 | if (posC > 0+n && posC < 10+n) { C = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 90 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 91 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 92 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 93 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 94 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 95 | } |
jaybehandsome | 6:1de63d5df56a | 96 | if (text == 'C'){ |
jaybehandsome | 6:1de63d5df56a | 97 | if (posA > 0+n && posA < 10+n) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 98 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 99 | else if(posA > 20+n && posA < 30+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 100 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 101 | else if(posA > 40+n && posA < 50+n ) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 102 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 103 | |
jaybehandsome | 6:1de63d5df56a | 104 | if (posB > 0+n && posB < 10+n) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 105 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 106 | else if(posB > 20+n && posB < 30+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 107 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 108 | else if(posB > 40+n && posB < 50+n ) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 109 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 110 | |
jaybehandsome | 6:1de63d5df56a | 111 | if (posC > 0+n && posC < 10+n) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 112 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 113 | else if(posC > 20+n && posC < 30+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 114 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 115 | else if(posC > 40+n && posC < 50+n ) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 116 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 117 | } |
jaybehandsome | 6:1de63d5df56a | 118 | if (text == 'D'){ |
jaybehandsome | 6:1de63d5df56a | 119 | if (posA > 0+n && posA < 10+n) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 120 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 121 | else if(posA > 20+n && posA < 30+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 122 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 123 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 124 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 125 | |
jaybehandsome | 6:1de63d5df56a | 126 | if (posB > 0+n && posB < 10+n) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 127 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 128 | else if(posB > 20+n && posB < 30+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 129 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 130 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 131 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 132 | |
jaybehandsome | 6:1de63d5df56a | 133 | if (posC > 0+n && posC < 10+n) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 134 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 135 | else if(posC > 20+n && posC < 30+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 136 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 137 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 138 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 139 | } |
jaybehandsome | 6:1de63d5df56a | 140 | if (text == 'E'){ |
jaybehandsome | 6:1de63d5df56a | 141 | if (posA > 0+n && posA < 10+n) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 142 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 143 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 144 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 145 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 146 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 147 | |
jaybehandsome | 6:1de63d5df56a | 148 | if (posB > 0+n && posB < 10+n) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 149 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 150 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 151 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 152 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 153 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 154 | |
jaybehandsome | 6:1de63d5df56a | 155 | if (posC > 0+n && posC < 10+n) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 156 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 157 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 158 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 159 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 160 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 161 | } |
jaybehandsome | 6:1de63d5df56a | 162 | if (text == 'F'){ |
jaybehandsome | 6:1de63d5df56a | 163 | if (posA > 0+n && posA < 10+n) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 164 | else if(posA > 10+n && posA < 20+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 165 | else if(posA > 20+n && posA < 30+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 166 | else if(posA > 30+n && posA < 40+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 167 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 168 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 169 | |
jaybehandsome | 6:1de63d5df56a | 170 | if (posB > 0+n && posB < 10+n) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 171 | else if(posB > 10+n && posB < 20+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 172 | else if(posB > 20+n && posB < 30+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 173 | else if(posB > 30+n && posB < 40+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 174 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 175 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 176 | |
jaybehandsome | 6:1de63d5df56a | 177 | if (posC > 0+n && posC < 10+n) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 178 | else if(posC > 10+n && posC < 20+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 179 | else if(posC > 20+n && posC < 30+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 180 | else if(posC > 30+n && posC < 40+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 181 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 182 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 183 | } |
jaybehandsome | 6:1de63d5df56a | 184 | if (text == 'G'){ |
jaybehandsome | 6:1de63d5df56a | 185 | if (posA > 0+n && posA < 10+n) { A = 0x4F; } |
jaybehandsome | 6:1de63d5df56a | 186 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 187 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 188 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 189 | else if(posA > 40+n && posA < 50+n ) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 190 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 191 | |
jaybehandsome | 6:1de63d5df56a | 192 | if (posB > 0+n && posB < 10+n) { B = 0x4F; } |
jaybehandsome | 6:1de63d5df56a | 193 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 194 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 195 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 196 | else if(posB > 40+n && posB < 50+n ) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 197 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 198 | |
jaybehandsome | 6:1de63d5df56a | 199 | if (posC > 0+n && posC < 10+n) { C = 0x4F; } |
jaybehandsome | 6:1de63d5df56a | 200 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 201 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 202 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 203 | else if(posC > 40+n && posC < 50+n ) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 204 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 205 | } |
jaybehandsome | 6:1de63d5df56a | 206 | if (text == 'H'){ |
jaybehandsome | 6:1de63d5df56a | 207 | if (posA > 0+n && posA < 10+n) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 208 | else if(posA > 10+n && posA < 20+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 209 | else if(posA > 20+n && posA < 30+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 210 | else if(posA > 30+n && posA < 40+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 211 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 212 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 213 | |
jaybehandsome | 6:1de63d5df56a | 214 | if (posB > 0+n && posB < 10+n) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 215 | else if(posB > 10+n && posB < 20+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 216 | else if(posB > 20+n && posB < 30+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 217 | else if(posB > 30+n && posB < 40+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 218 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 219 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 220 | |
jaybehandsome | 6:1de63d5df56a | 221 | if (posC > 0+n && posC < 10+n) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 222 | else if(posC > 10+n && posC < 20+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 223 | else if(posC > 20+n && posC < 30+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 224 | else if(posC > 30+n && posC < 40+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 225 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 226 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 227 | } |
jaybehandsome | 6:1de63d5df56a | 228 | if (text == 'I'){ |
jaybehandsome | 6:1de63d5df56a | 229 | if (posA > 0+n && posA < 10+n) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 230 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 231 | else if(posA > 20+n && posA < 30+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 232 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 233 | else if(posA > 40+n && posA < 50+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 234 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 235 | |
jaybehandsome | 6:1de63d5df56a | 236 | if (posB > 0+n && posB < 10+n) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 237 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 238 | else if(posB > 20+n && posB < 30+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 239 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 240 | else if(posB > 40+n && posB < 50+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 241 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 242 | |
jaybehandsome | 6:1de63d5df56a | 243 | if (posC > 0+n && posC < 10+n) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 244 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 245 | else if(posC > 20+n && posC < 30+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 246 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 247 | else if(posC > 40+n && posC < 50+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 248 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 249 | } |
jaybehandsome | 6:1de63d5df56a | 250 | if (text == 'J'){ |
jaybehandsome | 6:1de63d5df56a | 251 | if (posA > 0+n && posA < 10+n) { A = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 252 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 253 | else if(posA > 20+n && posA < 30+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 254 | else if(posA > 30+n && posA < 40+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 255 | else if(posA > 40+n && posA < 50+n ) { A = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 256 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 257 | |
jaybehandsome | 6:1de63d5df56a | 258 | if (posB > 0+n && posB < 10+n) { B = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 259 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 260 | else if(posB > 20+n && posB < 30+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 261 | else if(posB > 30+n && posB < 40+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 262 | else if(posB > 40+n && posB < 50+n ) { B = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 263 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 264 | |
jaybehandsome | 6:1de63d5df56a | 265 | if (posC > 0+n && posC < 10+n) { C = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 266 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 267 | else if(posC > 20+n && posC < 30+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 268 | else if(posC > 30+n && posC < 40+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 269 | else if(posC > 40+n && posC < 50+n ) { C = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 270 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 271 | } |
jaybehandsome | 6:1de63d5df56a | 272 | if (text == 'K'){ |
jaybehandsome | 6:1de63d5df56a | 273 | if (posA > 0+n && posA < 10+n) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 274 | else if(posA > 10+n && posA < 20+n ) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 275 | else if(posA > 20+n && posA < 30+n ) { A = 0x14; } |
jaybehandsome | 6:1de63d5df56a | 276 | else if(posA > 30+n && posA < 40+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 277 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 278 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 279 | |
jaybehandsome | 6:1de63d5df56a | 280 | if (posB > 0+n && posB < 10+n) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 281 | else if(posB > 10+n && posB < 20+n ) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 282 | else if(posB > 20+n && posB < 30+n ) { B = 0x14; } |
jaybehandsome | 6:1de63d5df56a | 283 | else if(posB > 30+n && posB < 40+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 284 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 285 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 286 | |
jaybehandsome | 6:1de63d5df56a | 287 | if (posC > 0+n && posC < 10+n) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 288 | else if(posC > 10+n && posC < 20+n ) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 289 | else if(posC > 20+n && posC < 30+n ) { C = 0x14; } |
jaybehandsome | 6:1de63d5df56a | 290 | else if(posC > 30+n && posC < 40+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 291 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 292 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 293 | } |
jaybehandsome | 6:1de63d5df56a | 294 | if (text == 'L'){ |
jaybehandsome | 6:1de63d5df56a | 295 | if (posA > 0+n && posA < 10+n) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 296 | else if(posA > 10+n && posA < 20+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 297 | else if(posA > 20+n && posA < 30+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 298 | else if(posA > 30+n && posA < 40+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 299 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 300 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 301 | |
jaybehandsome | 6:1de63d5df56a | 302 | if (posB > 0+n && posB < 10+n) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 303 | else if(posB > 10+n && posB < 20+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 304 | else if(posB > 20+n && posB < 30+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 305 | else if(posB > 30+n && posB < 40+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 306 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 307 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 308 | |
jaybehandsome | 6:1de63d5df56a | 309 | if (posC > 0+n && posC < 10+n) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 310 | else if(posC > 10+n && posC < 20+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 311 | else if(posC > 20+n && posC < 30+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 312 | else if(posC > 30+n && posC < 40+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 313 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 314 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 315 | } |
jaybehandsome | 6:1de63d5df56a | 316 | if (text == 'M'){ |
jaybehandsome | 6:1de63d5df56a | 317 | if (posA > 0+n && posA < 10+n) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 318 | else if(posA > 10+n && posA < 20+n ) { A = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 319 | else if(posA > 20+n && posA < 30+n ) { A = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 320 | else if(posA > 30+n && posA < 40+n ) { A = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 321 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 322 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 323 | |
jaybehandsome | 6:1de63d5df56a | 324 | if (posB > 0+n && posB < 10+n) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 325 | else if(posB > 10+n && posB < 20+n ) { B = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 326 | else if(posB > 20+n && posB < 30+n ) { B = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 327 | else if(posB > 30+n && posB < 40+n ) { B = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 328 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 329 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 330 | |
jaybehandsome | 6:1de63d5df56a | 331 | if (posC > 0+n && posC < 10+n) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 332 | else if(posC > 10+n && posC < 20+n ) { C = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 333 | else if(posC > 20+n && posC < 30+n ) { C = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 334 | else if(posC > 30+n && posC < 40+n ) { C = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 335 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 336 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 337 | } |
jaybehandsome | 6:1de63d5df56a | 338 | if (text == 'N'){ |
jaybehandsome | 6:1de63d5df56a | 339 | if (posA > 0+n && posA < 10+n) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 340 | else if(posA > 10+n && posA < 20+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 341 | else if(posA > 20+n && posA < 30+n ) { A = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 342 | else if(posA > 30+n && posA < 40+n ) { A = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 343 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 344 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 345 | |
jaybehandsome | 6:1de63d5df56a | 346 | if (posB > 0+n && posB < 10+n) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 347 | else if(posB > 10+n && posB < 20+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 348 | else if(posB > 20+n && posB < 30+n ) { B = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 349 | else if(posB > 30+n && posB < 40+n ) { B = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 350 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 351 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 352 | |
jaybehandsome | 6:1de63d5df56a | 353 | if (posC > 0+n && posC < 10+n) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 354 | else if(posC > 10+n && posC < 20+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 355 | else if(posC > 20+n && posC < 30+n ) { C = 0x10; } |
jaybehandsome | 6:1de63d5df56a | 356 | else if(posC > 30+n && posC < 40+n ) { C = 0x20; } |
jaybehandsome | 6:1de63d5df56a | 357 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 358 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 359 | } |
jaybehandsome | 6:1de63d5df56a | 360 | if (text == 'O'){ |
jaybehandsome | 6:1de63d5df56a | 361 | if (posA > 0+n && posA < 10+n) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 362 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 363 | else if(posA > 20+n && posA < 30+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 364 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 365 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 366 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 367 | |
jaybehandsome | 6:1de63d5df56a | 368 | if (posB > 0+n && posB < 10+n) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 369 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 370 | else if(posB > 20+n && posB < 30+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 371 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 372 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 373 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 374 | |
jaybehandsome | 6:1de63d5df56a | 375 | if (posC > 0+n && posC < 10+n) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 376 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 377 | else if(posC > 20+n && posC < 30+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 378 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 379 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 380 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 381 | } |
jaybehandsome | 6:1de63d5df56a | 382 | if (text == 'P'){ |
jaybehandsome | 6:1de63d5df56a | 383 | if (posA > 0+n && posA < 10+n) { A = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 384 | else if(posA > 10+n && posA < 20+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 385 | else if(posA > 20+n && posA < 30+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 386 | else if(posA > 30+n && posA < 40+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 387 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 388 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 389 | |
jaybehandsome | 6:1de63d5df56a | 390 | if (posB > 0+n && posB < 10+n) { B = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 391 | else if(posB > 10+n && posB < 20+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 392 | else if(posB > 20+n && posB < 30+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 393 | else if(posB > 30+n && posB < 40+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 394 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 395 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 396 | |
jaybehandsome | 6:1de63d5df56a | 397 | if (posC > 0+n && posC < 10+n) { C = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 398 | else if(posC > 10+n && posC < 20+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 399 | else if(posC > 20+n && posC < 30+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 400 | else if(posC > 30+n && posC < 40+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 401 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 402 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 403 | } |
jaybehandsome | 6:1de63d5df56a | 404 | if (text == 'Q'){ |
jaybehandsome | 6:1de63d5df56a | 405 | if (posA > 0+n && posA < 10+n) { A = 0x3D; } |
jaybehandsome | 6:1de63d5df56a | 406 | else if(posA > 10+n && posA < 20+n ) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 407 | else if(posA > 20+n && posA < 30+n ) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 408 | else if(posA > 30+n && posA < 40+n ) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 409 | else if(posA > 40+n && posA < 50+n ) { A = 0x3C; } |
jaybehandsome | 6:1de63d5df56a | 410 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 411 | |
jaybehandsome | 6:1de63d5df56a | 412 | if (posB > 0+n && posB < 10+n) { B = 0x3D; } |
jaybehandsome | 6:1de63d5df56a | 413 | else if(posB > 10+n && posB < 20+n ) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 414 | else if(posB > 20+n && posB < 30+n ) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 415 | else if(posB > 30+n && posB < 40+n ) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 416 | else if(posB > 40+n && posB < 50+n ) { B = 0x3C; } |
jaybehandsome | 6:1de63d5df56a | 417 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 418 | |
jaybehandsome | 6:1de63d5df56a | 419 | if (posC > 0+n && posC < 10+n) { C = 0x3D; } |
jaybehandsome | 6:1de63d5df56a | 420 | else if(posC > 10+n && posC < 20+n ) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 421 | else if(posC > 20+n && posC < 30+n ) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 422 | else if(posC > 30+n && posC < 40+n ) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 423 | else if(posC > 40+n && posC < 50+n ) { C = 0x3C; } |
jaybehandsome | 6:1de63d5df56a | 424 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 425 | } |
jaybehandsome | 6:1de63d5df56a | 426 | if (text == 'R'){ |
jaybehandsome | 6:1de63d5df56a | 427 | if (posA > 0+n && posA < 10+n) { A = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 428 | else if(posA > 10+n && posA < 20+n ) { A = 0x4A; } |
jaybehandsome | 6:1de63d5df56a | 429 | else if(posA > 20+n && posA < 30+n ) { A = 0x4C; } |
jaybehandsome | 6:1de63d5df56a | 430 | else if(posA > 30+n && posA < 40+n ) { A = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 431 | else if(posA > 40+n && posA < 50+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 432 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 433 | |
jaybehandsome | 6:1de63d5df56a | 434 | if (posB > 0+n && posB < 10+n) { B = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 435 | else if(posB > 10+n && posB < 20+n ) { B = 0x4A; } |
jaybehandsome | 6:1de63d5df56a | 436 | else if(posB > 20+n && posB < 30+n ) { B = 0x4C; } |
jaybehandsome | 6:1de63d5df56a | 437 | else if(posB > 30+n && posB < 40+n ) { B = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 438 | else if(posB > 40+n && posB < 50+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 439 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 440 | |
jaybehandsome | 6:1de63d5df56a | 441 | if (posC > 0+n && posC < 10+n) { C = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 442 | else if(posC > 10+n && posC < 20+n ) { C = 0x4A; } |
jaybehandsome | 6:1de63d5df56a | 443 | else if(posC > 20+n && posC < 30+n ) { C = 0x4C; } |
jaybehandsome | 6:1de63d5df56a | 444 | else if(posC > 30+n && posC < 40+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 445 | else if(posC > 40+n && posC < 50+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 446 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 447 | } |
jaybehandsome | 6:1de63d5df56a | 448 | if (text == 'S'){ |
jaybehandsome | 6:1de63d5df56a | 449 | if (posA > 0+n && posA < 10+n) { A = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 450 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 451 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 452 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 453 | else if(posA > 40+n && posA < 50+n ) { A = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 454 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 455 | |
jaybehandsome | 6:1de63d5df56a | 456 | if (posB > 0+n && posB < 10+n) { B = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 457 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 458 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 459 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 460 | else if(posB > 40+n && posB < 50+n ) { B = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 461 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 462 | |
jaybehandsome | 6:1de63d5df56a | 463 | if (posC > 0+n && posC < 10+n) { C = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 464 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 465 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 466 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 467 | else if(posC > 40+n && posC < 50+n ) { C = 0x31; } |
jaybehandsome | 6:1de63d5df56a | 468 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 469 | } |
jaybehandsome | 6:1de63d5df56a | 470 | if (text == 'T'){ |
jaybehandsome | 6:1de63d5df56a | 471 | if (posA > 0+n && posA < 10+n) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 472 | else if(posA > 10+n && posA < 20+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 473 | else if(posA > 20+n && posA < 30+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 474 | else if(posA > 30+n && posA < 40+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 475 | else if(posA > 40+n && posA < 50+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 476 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 477 | |
jaybehandsome | 6:1de63d5df56a | 478 | if (posB > 0+n && posB < 10+n) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 479 | else if(posB > 10+n && posB < 20+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 480 | else if(posB > 20+n && posB < 30+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 481 | else if(posB > 30+n && posB < 40+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 482 | else if(posB > 40+n && posB < 50+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 483 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 484 | |
jaybehandsome | 6:1de63d5df56a | 485 | if (posC > 0+n && posC < 10+n) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 486 | else if(posC > 10+n && posC < 20+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 487 | else if(posC > 20+n && posC < 30+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 488 | else if(posC > 30+n && posC < 40+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 489 | else if(posC > 40+n && posC < 50+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 490 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 491 | } |
jaybehandsome | 6:1de63d5df56a | 492 | if (text == 'U'){ |
jaybehandsome | 6:1de63d5df56a | 493 | if (posA > 0+n && posA < 10+n) { A = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 494 | else if(posA > 10+n && posA < 20+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 495 | else if(posA > 20+n && posA < 30+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 496 | else if(posA > 30+n && posA < 40+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 497 | else if(posA > 40+n && posA < 50+n ) { A = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 498 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 499 | |
jaybehandsome | 6:1de63d5df56a | 500 | if (posB > 0+n && posB < 10+n) { B = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 501 | else if(posB > 10+n && posB < 20+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 502 | else if(posB > 20+n && posB < 30+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 503 | else if(posB > 30+n && posB < 40+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 504 | else if(posB > 40+n && posB < 50+n ) { B = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 505 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 506 | |
jaybehandsome | 6:1de63d5df56a | 507 | if (posC > 0+n && posC < 10+n) { C = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 508 | else if(posC > 10+n && posC < 20+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 509 | else if(posC > 20+n && posC < 30+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 510 | else if(posC > 30+n && posC < 40+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 511 | else if(posC > 40+n && posC < 50+n ) { C = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 512 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 513 | } |
jaybehandsome | 6:1de63d5df56a | 514 | if (text == 'V'){ |
jaybehandsome | 6:1de63d5df56a | 515 | if (posA > 0+n && posA < 10+n) { A = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 516 | else if(posA > 10+n && posA < 20+n ) { A = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 517 | else if(posA > 20+n && posA < 30+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 518 | else if(posA > 30+n && posA < 40+n ) { A = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 519 | else if(posA > 40+n && posA < 50+n ) { A = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 520 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 521 | |
jaybehandsome | 6:1de63d5df56a | 522 | if (posB > 0+n && posB < 10+n) { B = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 523 | else if(posB > 10+n && posB < 20+n ) { B = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 524 | else if(posB > 20+n && posB < 30+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 525 | else if(posB > 30+n && posB < 40+n ) { B = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 526 | else if(posB > 40+n && posB < 50+n ) { B = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 527 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 528 | |
jaybehandsome | 6:1de63d5df56a | 529 | if (posC > 0+n && posC < 10+n) { C = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 530 | else if(posC > 10+n && posC < 20+n ) { C = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 531 | else if(posC > 20+n && posC < 30+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 532 | else if(posC > 30+n && posC < 40+n ) { C = 0x02; } |
jaybehandsome | 6:1de63d5df56a | 533 | else if(posC > 40+n && posC < 50+n ) { C = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 534 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 535 | } |
jaybehandsome | 6:1de63d5df56a | 536 | if (text == 'W'){ |
jaybehandsome | 6:1de63d5df56a | 537 | if (posA > 0+n && posA < 10+n) { A = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 538 | else if(posA > 10+n && posA < 20+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 539 | else if(posA > 20+n && posA < 30+n ) { A = 0x0E; } |
jaybehandsome | 6:1de63d5df56a | 540 | else if(posA > 30+n && posA < 40+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 541 | else if(posA > 40+n && posA < 50+n ) { A = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 542 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 543 | |
jaybehandsome | 6:1de63d5df56a | 544 | if (posB > 0+n && posB < 10+n) { B = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 545 | else if(posB > 10+n && posB < 20+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 546 | else if(posB > 20+n && posB < 30+n ) { B = 0x0E; } |
jaybehandsome | 6:1de63d5df56a | 547 | else if(posB > 30+n && posB < 40+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 548 | else if(posB > 40+n && posB < 50+n ) { B = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 549 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 550 | |
jaybehandsome | 6:1de63d5df56a | 551 | if (posC > 0+n && posC < 10+n) { C = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 552 | else if(posC > 10+n && posC < 20+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 553 | else if(posC > 20+n && posC < 30+n ) { C = 0x0E; } |
jaybehandsome | 6:1de63d5df56a | 554 | else if(posC > 30+n && posC < 40+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 555 | else if(posC > 40+n && posC < 50+n ) { C = 0x7E; } |
jaybehandsome | 6:1de63d5df56a | 556 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 557 | } |
jaybehandsome | 6:1de63d5df56a | 558 | if (text == 'X'){ |
jaybehandsome | 6:1de63d5df56a | 559 | if (posA > 0+n && posA < 10+n) { A = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 560 | else if(posA > 10+n && posA < 20+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 561 | else if(posA > 20+n && posA < 30+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 562 | else if(posA > 30+n && posA < 40+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 563 | else if(posA > 40+n && posA < 50+n ) { A = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 564 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 565 | |
jaybehandsome | 6:1de63d5df56a | 566 | if (posB > 0+n && posB < 10+n) { B = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 567 | else if(posB > 10+n && posB < 20+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 568 | else if(posB > 20+n && posB < 30+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 569 | else if(posB > 30+n && posB < 40+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 570 | else if(posB > 40+n && posB < 50+n ) { B = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 571 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 572 | |
jaybehandsome | 6:1de63d5df56a | 573 | if (posC > 0+n && posC < 10+n) { C = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 574 | else if(posC > 10+n && posC < 20+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 575 | else if(posC > 20+n && posC < 30+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 576 | else if(posC > 30+n && posC < 40+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 577 | else if(posC > 40+n && posC < 50+n ) { C = 0x77; } |
jaybehandsome | 6:1de63d5df56a | 578 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 579 | } |
jaybehandsome | 6:1de63d5df56a | 580 | if (text == 'Y'){ |
jaybehandsome | 6:1de63d5df56a | 581 | if (posA > 0+n && posA < 10+n) { A = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 582 | else if(posA > 10+n && posA < 20+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 583 | else if(posA > 20+n && posA < 30+n ) { A = 0x07; } |
jaybehandsome | 6:1de63d5df56a | 584 | else if(posA > 30+n && posA < 40+n ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 585 | else if(posA > 40+n && posA < 50+n ) { A = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 586 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 587 | |
jaybehandsome | 6:1de63d5df56a | 588 | if (posB > 0+n && posB < 10+n) { B = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 589 | else if(posB > 10+n && posB < 20+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 590 | else if(posB > 20+n && posB < 30+n ) { B = 0x07; } |
jaybehandsome | 6:1de63d5df56a | 591 | else if(posB > 30+n && posB < 40+n ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 592 | else if(posB > 40+n && posB < 50+n ) { B = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 593 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 594 | |
jaybehandsome | 6:1de63d5df56a | 595 | if (posC > 0+n && posC < 10+n) { C = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 596 | else if(posC > 10+n && posC < 20+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 597 | else if(posC > 20+n && posC < 30+n ) { C = 0x07; } |
jaybehandsome | 6:1de63d5df56a | 598 | else if(posC > 30+n && posC < 40+n ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 599 | else if(posC > 40+n && posC < 50+n ) { C = 0x70; } |
jaybehandsome | 6:1de63d5df56a | 600 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 601 | } |
jaybehandsome | 6:1de63d5df56a | 602 | if (text == 'Z'){ |
jaybehandsome | 6:1de63d5df56a | 603 | if (posA > 0+n && posA < 10+n) { A = 0x61; } |
jaybehandsome | 6:1de63d5df56a | 604 | else if(posA > 10+n && posA < 20+n ) { A = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 605 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 606 | else if(posA > 30+n && posA < 40+n ) { A = 0x45; } |
jaybehandsome | 6:1de63d5df56a | 607 | else if(posA > 40+n && posA < 50+n ) { A = 0x43; } |
jaybehandsome | 6:1de63d5df56a | 608 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 609 | |
jaybehandsome | 6:1de63d5df56a | 610 | if (posB > 0+n && posB < 10+n) { B = 0x61; } |
jaybehandsome | 6:1de63d5df56a | 611 | else if(posB > 10+n && posB < 20+n ) { B = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 612 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 613 | else if(posB > 30+n && posB < 40+n ) { B = 0x45; } |
jaybehandsome | 6:1de63d5df56a | 614 | else if(posB > 40+n && posB < 50+n ) { B = 0x43; } |
jaybehandsome | 6:1de63d5df56a | 615 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 616 | |
jaybehandsome | 6:1de63d5df56a | 617 | if (posC > 0+n && posC < 10+n) { C = 0x61; } |
jaybehandsome | 6:1de63d5df56a | 618 | else if(posC > 10+n && posC < 20+n ) { C = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 619 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 620 | else if(posC > 30+n && posC < 40+n ) { C = 0x45; } |
jaybehandsome | 6:1de63d5df56a | 621 | else if(posC > 40+n && posC < 50+n ) { C = 0x43; } |
jaybehandsome | 6:1de63d5df56a | 622 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 623 | } |
jaybehandsome | 6:1de63d5df56a | 624 | if (text == '0'){ |
jaybehandsome | 6:1de63d5df56a | 625 | if (posA > 0+n && posA < 10+n) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 626 | else if(posA > 10+n && posA < 20+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 627 | else if(posA > 20+n && posA < 30+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 628 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 629 | else if(posA > 40+n && posA < 50+n ) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 630 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 631 | |
jaybehandsome | 6:1de63d5df56a | 632 | if (posB > 0+n && posB < 10+n) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 633 | else if(posB > 10+n && posB < 20+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 634 | else if(posB > 20+n && posB < 30+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 635 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 636 | else if(posB > 40+n && posB < 50+n ) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 637 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 638 | |
jaybehandsome | 6:1de63d5df56a | 639 | if (posC > 0+n && posC < 10+n) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 640 | else if(posC > 10+n && posC < 20+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 641 | else if(posC > 20+n && posC < 30+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 642 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 643 | else if(posC > 40+n && posC < 50+n ) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 644 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 645 | } |
jaybehandsome | 6:1de63d5df56a | 646 | if (text == '1'){ |
jaybehandsome | 6:1de63d5df56a | 647 | if (posA > 0+n && posA < 10+n) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 648 | else if(posA > 10+n && posA < 20+n ) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 649 | else if(posA > 20+n && posA < 30+n ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 650 | else if(posA > 30+n && posA < 40+n ) { A = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 651 | else if(posA > 40+n && posA < 50+n ) { A = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 652 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 653 | |
jaybehandsome | 6:1de63d5df56a | 654 | if (posB > 0+n && posB < 10+n) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 655 | else if(posB > 10+n && posB < 20+n ) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 656 | else if(posB > 20+n && posB < 30+n ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 657 | else if(posB > 30+n && posB < 40+n ) { B = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 658 | else if(posB > 40+n && posB < 50+n ) { B = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 659 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 660 | |
jaybehandsome | 6:1de63d5df56a | 661 | if (posC > 0+n && posC < 10+n) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 662 | else if(posC > 10+n && posC < 20+n ) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 663 | else if(posC > 20+n && posC < 30+n ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 664 | else if(posC > 30+n && posC < 40+n ) { C = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 665 | else if(posC > 40+n && posC < 50+n ) { C = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 666 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 667 | } |
jaybehandsome | 6:1de63d5df56a | 668 | if (text == '2'){ |
jaybehandsome | 6:1de63d5df56a | 669 | if (posA > 0+n && posA < 10+n) { A = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 670 | else if(posA > 10+n && posA < 20+n ) { A = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 671 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 672 | else if(posA > 30+n && posA < 40+n ) { A = 0x45; } |
jaybehandsome | 6:1de63d5df56a | 673 | else if(posA > 40+n && posA < 50+n ) { A = 0x23; } |
jaybehandsome | 6:1de63d5df56a | 674 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 675 | |
jaybehandsome | 6:1de63d5df56a | 676 | if (posB > 0+n && posB < 10+n) { B = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 677 | else if(posB > 10+n && posB < 20+n ) { B = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 678 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 679 | else if(posB > 30+n && posB < 40+n ) { B = 0x45; } |
jaybehandsome | 6:1de63d5df56a | 680 | else if(posB > 40+n && posB < 50+n ) { B = 0x23; } |
jaybehandsome | 6:1de63d5df56a | 681 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 682 | |
jaybehandsome | 6:1de63d5df56a | 683 | if (posC > 0+n && posC < 10+n) { C = 0x21; } |
jaybehandsome | 6:1de63d5df56a | 684 | else if(posC > 10+n && posC < 20+n ) { C = 0x51; } |
jaybehandsome | 6:1de63d5df56a | 685 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 686 | else if(posC > 30+n && posC < 40+n ) { C = 0x48; } |
jaybehandsome | 6:1de63d5df56a | 687 | else if(posC > 40+n && posC < 50+n ) { C = 0x23; } |
jaybehandsome | 6:1de63d5df56a | 688 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 689 | } |
jaybehandsome | 6:1de63d5df56a | 690 | if (text == '3'){ |
jaybehandsome | 6:1de63d5df56a | 691 | if (posA > 0+n && posA < 10+n) { A = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 692 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 693 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 694 | else if(posA > 30+n && posA < 40+n ) { A = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 695 | else if(posA > 40+n && posA < 50+n ) { A = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 696 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 697 | |
jaybehandsome | 6:1de63d5df56a | 698 | if (posB > 0+n && posB < 10+n) { B = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 699 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 700 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 701 | else if(posB > 30+n && posB < 40+n ) { B = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 702 | else if(posB > 40+n && posB < 50+n ) { B = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 703 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 704 | |
jaybehandsome | 6:1de63d5df56a | 705 | if (posC > 0+n && posC < 10+n) { C = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 706 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 707 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 708 | else if(posC > 30+n && posC < 40+n ) { C = 0x41; } |
jaybehandsome | 6:1de63d5df56a | 709 | else if(posC > 40+n && posC < 50+n ) { C = 0x22; } |
jaybehandsome | 6:1de63d5df56a | 710 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 711 | } |
jaybehandsome | 6:1de63d5df56a | 712 | if (text == '4'){ |
jaybehandsome | 6:1de63d5df56a | 713 | if (posA > 0+n && posA < 10+n) { A = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 714 | else if(posA > 10+n && posA < 20+n ) { A = 0x1F; } |
jaybehandsome | 6:1de63d5df56a | 715 | else if(posA > 20+n && posA < 30+n ) { A = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 716 | else if(posA > 30+n && posA < 40+n ) { A = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 717 | else if(posA > 40+n && posA < 50+n ) { A = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 718 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 719 | |
jaybehandsome | 6:1de63d5df56a | 720 | if (posB > 0+n && posB < 10+n) { B = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 721 | else if(posB > 10+n && posB < 20+n ) { B = 0x1F; } |
jaybehandsome | 6:1de63d5df56a | 722 | else if(posB > 20+n && posB < 30+n ) { B = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 723 | else if(posB > 30+n && posB < 40+n ) { B = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 724 | else if(posB > 40+n && posB < 50+n ) { B = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 725 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 726 | |
jaybehandsome | 6:1de63d5df56a | 727 | if (posC > 0+n && posC < 10+n) { C = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 728 | else if(posC > 10+n && posC < 20+n ) { C = 0x1F; } |
jaybehandsome | 6:1de63d5df56a | 729 | else if(posC > 20+n && posC < 30+n ) { C = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 730 | else if(posC > 30+n && posC < 40+n ) { C = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 731 | else if(posC > 40+n && posC < 50+n ) { C = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 732 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 733 | } |
jaybehandsome | 6:1de63d5df56a | 734 | if (text == '5'){ |
jaybehandsome | 6:1de63d5df56a | 735 | if (posA > 0+n && posA < 10+n) { A = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 736 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 737 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 738 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 739 | else if(posA > 40+n && posA < 50+n ) { A = 0x79; } |
jaybehandsome | 6:1de63d5df56a | 740 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 741 | |
jaybehandsome | 6:1de63d5df56a | 742 | if (posB > 0+n && posB < 10+n) { B = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 743 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 744 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 745 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 746 | else if(posB > 40+n && posB < 50+n ) { B = 0x79; } |
jaybehandsome | 6:1de63d5df56a | 747 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 748 | |
jaybehandsome | 6:1de63d5df56a | 749 | if (posC > 0+n && posC < 10+n) { C = 0x46; } |
jaybehandsome | 6:1de63d5df56a | 750 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 751 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 752 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 753 | else if(posC > 40+n && posC < 50+n ) { C = 0x7C; } |
jaybehandsome | 6:1de63d5df56a | 754 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 755 | } |
jaybehandsome | 6:1de63d5df56a | 756 | if (text == '6'){ |
jaybehandsome | 6:1de63d5df56a | 757 | if (posA > 0+n && posA < 10+n) { A = 0x26; } |
jaybehandsome | 6:1de63d5df56a | 758 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 759 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 760 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 761 | else if(posA > 40+n && posA < 50+n ) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 762 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 763 | |
jaybehandsome | 6:1de63d5df56a | 764 | if (posB > 0+n && posB < 10+n) { B = 0x26; } |
jaybehandsome | 6:1de63d5df56a | 765 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 766 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 767 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 768 | else if(posB > 40+n && posB < 50+n ) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 769 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 770 | |
jaybehandsome | 6:1de63d5df56a | 771 | if (posC > 0+n && posC < 10+n) { C = 0x26; } |
jaybehandsome | 6:1de63d5df56a | 772 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 773 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 774 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 775 | else if(posC > 40+n && posC < 50+n ) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 776 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 777 | } |
jaybehandsome | 6:1de63d5df56a | 778 | if (text == '7'){ |
jaybehandsome | 6:1de63d5df56a | 779 | if (posA > 0+n && posA < 10+n) { A = 0x60; } |
jaybehandsome | 6:1de63d5df56a | 780 | else if(posA > 10+n && posA < 20+n ) { A = 0x50; } |
jaybehandsome | 6:1de63d5df56a | 781 | else if(posA > 20+n && posA < 30+n ) { A = 0x47; } |
jaybehandsome | 6:1de63d5df56a | 782 | else if(posA > 30+n && posA < 40+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 783 | else if(posA > 40+n && posA < 50+n ) { A = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 784 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 785 | |
jaybehandsome | 6:1de63d5df56a | 786 | if (posB > 0+n && posB < 10+n) { B = 0x60; } |
jaybehandsome | 6:1de63d5df56a | 787 | else if(posB > 10+n && posB < 20+n ) { B = 0x50; } |
jaybehandsome | 6:1de63d5df56a | 788 | else if(posB > 20+n && posB < 30+n ) { B = 0x47; } |
jaybehandsome | 6:1de63d5df56a | 789 | else if(posB > 30+n && posB < 40+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 790 | else if(posB > 40+n && posB < 50+n ) { B = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 791 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 792 | |
jaybehandsome | 6:1de63d5df56a | 793 | if (posC > 0+n && posC < 10+n) { C = 0x60; } |
jaybehandsome | 6:1de63d5df56a | 794 | else if(posC > 10+n && posC < 20+n ) { C = 0x50; } |
jaybehandsome | 6:1de63d5df56a | 795 | else if(posC > 20+n && posC < 30+n ) { C = 0x47; } |
jaybehandsome | 6:1de63d5df56a | 796 | else if(posC > 30+n && posC < 40+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 797 | else if(posC > 40+n && posC < 50+n ) { C = 0x40; } |
jaybehandsome | 6:1de63d5df56a | 798 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 799 | } |
jaybehandsome | 6:1de63d5df56a | 800 | if (text == '8'){ |
jaybehandsome | 6:1de63d5df56a | 801 | if (posA > 0+n && posA < 10+n) { A = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 802 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 803 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 804 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 805 | else if(posA > 40+n && posA < 50+n ) { A = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 806 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 807 | |
jaybehandsome | 6:1de63d5df56a | 808 | if (posB > 0+n && posB < 10+n) { B = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 809 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 810 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 811 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 812 | else if(posB > 40+n && posB < 50+n ) { B = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 813 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 814 | |
jaybehandsome | 6:1de63d5df56a | 815 | if (posC > 0+n && posC < 10+n) { C = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 816 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 817 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 818 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 819 | else if(posC > 40+n && posC < 50+n ) { C = 0x36; } |
jaybehandsome | 6:1de63d5df56a | 820 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 821 | } |
jaybehandsome | 6:1de63d5df56a | 822 | if (text == '9'){ |
jaybehandsome | 6:1de63d5df56a | 823 | if (posA > 0+n && posA < 10+n) { A = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 824 | else if(posA > 10+n && posA < 20+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 825 | else if(posA > 20+n && posA < 30+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 826 | else if(posA > 30+n && posA < 40+n ) { A = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 827 | else if(posA > 40+n && posA < 50+n ) { A = 0x32; } |
jaybehandsome | 6:1de63d5df56a | 828 | else if(posA > 50+n && posA < 60+n ) { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 829 | |
jaybehandsome | 6:1de63d5df56a | 830 | if (posB > 0+n && posB < 10+n) { B = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 831 | else if(posB > 10+n && posB < 20+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 832 | else if(posB > 20+n && posB < 30+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 833 | else if(posB > 30+n && posB < 40+n ) { B = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 834 | else if(posB > 40+n && posB < 50+n ) { B = 0x32; } |
jaybehandsome | 6:1de63d5df56a | 835 | else if(posB > 50+n && posB < 60+n ) { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 836 | |
jaybehandsome | 6:1de63d5df56a | 837 | if (posC > 0+n && posC < 10+n) { C = 0x3E; } |
jaybehandsome | 6:1de63d5df56a | 838 | else if(posC > 10+n && posC < 20+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 839 | else if(posC > 20+n && posC < 30+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 840 | else if(posC > 30+n && posC < 40+n ) { C = 0x49; } |
jaybehandsome | 6:1de63d5df56a | 841 | else if(posC > 40+n && posC < 50+n ) { C = 0x32; } |
jaybehandsome | 6:1de63d5df56a | 842 | else if(posC > 50+n && posC < 60+n ) { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 843 | } |
jaybehandsome | 6:1de63d5df56a | 844 | } |
jaybehandsome | 6:1de63d5df56a | 845 | |
jaybehandsome | 6:1de63d5df56a | 846 | void Velocity(int v ,float posA,float posB,float posC){ |
jaybehandsome | 6:1de63d5df56a | 847 | char value[3] ; |
jaybehandsome | 6:1de63d5df56a | 848 | sprintf(value ,"%.2f",(v*10)); |
jaybehandsome | 6:1de63d5df56a | 849 | Text(value[0],posA,posB,posC,0); |
jaybehandsome | 6:1de63d5df56a | 850 | Text(value[1],posA,posB,posC,1); |
jaybehandsome | 6:1de63d5df56a | 851 | if (posA > 110 && posA < 120) { A = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 852 | if (posB > 110 && posB < 120) { B = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 853 | if (posC > 110 && posC < 120) { C = 0x01; } |
jaybehandsome | 6:1de63d5df56a | 854 | Text(value[2],posA,posB,posC,2); |
jaybehandsome | 6:1de63d5df56a | 855 | if (posA > 180 && posA < 190) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 856 | else if(posA > 190 && posA < 200 ) { A = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 857 | else if(posA > 210 && posA < 220 ) { A = 0x0A; } |
jaybehandsome | 6:1de63d5df56a | 858 | else if(posA > 220 && posA < 230 ) { A = 0x11; } |
jaybehandsome | 6:1de63d5df56a | 859 | else if(posA > 230 && posA < 240 ) { A = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 860 | else if(posA > 240 && posA < 250 ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 861 | else if(posA > 250 && posA < 260 ) { A = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 862 | else if(posA > 260 && posA < 270 ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 863 | else if(posA > 270 && posA < 280 ) { A = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 864 | else if(posA > 280 && posA < 290 ) { A = 0x03; } |
jaybehandsome | 6:1de63d5df56a | 865 | else if(posA > 290 && posA < 300 ) { A = 0x0C; } |
jaybehandsome | 6:1de63d5df56a | 866 | else if(posA > 300 && posA < 310 ) { A = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 867 | else if(posA > 310 && posA < 320 ) { A = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 868 | else if(posA > 320 && posA < 330 ) { A = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 869 | else if(posA > 330 && posA < 340 ) { A = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 870 | else { A = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 871 | |
jaybehandsome | 6:1de63d5df56a | 872 | if (posB > 180 && posB < 190) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 873 | else if(posB > 190 && posB < 200 ) { B = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 874 | else if(posB > 210 && posB < 220 ) { B = 0x0A; } |
jaybehandsome | 6:1de63d5df56a | 875 | else if(posB > 220 && posB < 230 ) { B = 0x11; } |
jaybehandsome | 6:1de63d5df56a | 876 | else if(posB > 230 && posB < 240 ) { B = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 877 | else if(posB > 240 && posB < 250 ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 878 | else if(posB > 250 && posB < 260 ) { B = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 879 | else if(posB > 260 && posB < 270 ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 880 | else if(posB > 270 && posB < 280 ) { B = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 881 | else if(posB > 280 && posB < 290 ) { B = 0x03; } |
jaybehandsome | 6:1de63d5df56a | 882 | else if(posB > 290 && posB < 300 ) { B = 0x0C; } |
jaybehandsome | 6:1de63d5df56a | 883 | else if(posB > 300 && posB < 310 ) { B = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 884 | else if(posB > 310 && posB < 320 ) { B = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 885 | else if(posB > 320 && posB < 330 ) { B = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 886 | else if(posB > 330 && posB < 340 ) { B = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 887 | else { B = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 888 | |
jaybehandsome | 6:1de63d5df56a | 889 | if (posC > 180 && posC < 190) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 890 | else if(posC > 190 && posC < 200 ) { C = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 891 | else if(posC > 210 && posC < 220 ) { C = 0x0A; } |
jaybehandsome | 6:1de63d5df56a | 892 | else if(posC > 220 && posC < 230 ) { C = 0x11; } |
jaybehandsome | 6:1de63d5df56a | 893 | else if(posC > 230 && posC < 240 ) { C = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 894 | else if(posC > 240 && posC < 250 ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 895 | else if(posC > 250 && posC < 260 ) { C = 0x04; } |
jaybehandsome | 6:1de63d5df56a | 896 | else if(posC > 260 && posC < 270 ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 897 | else if(posC > 270 && posC < 280 ) { C = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 898 | else if(posC > 280 && posC < 290 ) { C = 0x03; } |
jaybehandsome | 6:1de63d5df56a | 899 | else if(posC > 290 && posC < 300 ) { C = 0x0C; } |
jaybehandsome | 6:1de63d5df56a | 900 | else if(posC > 300 && posC < 310 ) { C = 0x30; } |
jaybehandsome | 6:1de63d5df56a | 901 | else if(posC > 310 && posC < 320 ) { C = 0x7F; } |
jaybehandsome | 6:1de63d5df56a | 902 | else if(posC > 320 && posC < 330 ) { C = 0x08; } |
jaybehandsome | 6:1de63d5df56a | 903 | else if(posC > 330 && posC < 340 ) { C = 0x0F; } |
jaybehandsome | 6:1de63d5df56a | 904 | else { C = 0x00; } |
jaybehandsome | 6:1de63d5df56a | 905 | } |
jaybehandsome | 6:1de63d5df56a | 906 | |
jaybehandsome | 5:738285670edf | 907 | float posA = 0,posB,posC; |
jaybehandsome | 6:1de63d5df56a | 908 | |
jaybehandsome | 6:1de63d5df56a | 909 | |
jaybehandsome | 6:1de63d5df56a | 910 | |
jaybehandsome | 6:1de63d5df56a | 911 | |
jaybehandsome | 6:1de63d5df56a | 912 | |
jaybehandsome | 6:1de63d5df56a | 913 | |
jaybehandsome | 6:1de63d5df56a | 914 | |
jaybehandsome | 6:1de63d5df56a | 915 | |
jaybehandsome | 6:1de63d5df56a | 916 | |
jaybehandsome | 0:1e46c1a32764 | 917 | int main() |
jaybehandsome | 0:1e46c1a32764 | 918 | { |
jaybehandsome | 6:1de63d5df56a | 919 | A = 0; |
jaybehandsome | 6:1de63d5df56a | 920 | B = 0; |
jaybehandsome | 6:1de63d5df56a | 921 | C = 0; |
jaybehandsome | 5:738285670edf | 922 | mode = 0; |
jaybehandsome | 5:738285670edf | 923 | pc.baud(38400); |
jaybehandsome | 0:1e46c1a32764 | 924 | //Set up I2C |
jaybehandsome | 0:1e46c1a32764 | 925 | i2c.frequency(400000); // use fast (400 kHz) I2C |
jaybehandsome | 0:1e46c1a32764 | 926 | |
jaybehandsome | 5:738285670edf | 927 | bam.printf("CPU SystemCoreClock is %d Hz\r\n", SystemCoreClock); |
jaybehandsome | 0:1e46c1a32764 | 928 | |
jaybehandsome | 0:1e46c1a32764 | 929 | t.start(); |
jaybehandsome | 0:1e46c1a32764 | 930 | |
jaybehandsome | 0:1e46c1a32764 | 931 | |
jaybehandsome | 0:1e46c1a32764 | 932 | // Read the WHO_AM_I register, this is a good test of communication |
jaybehandsome | 0:1e46c1a32764 | 933 | uint8_t whoami = mpu9250.readByte(MPU9250_ADDRESS, WHO_AM_I_MPU9250); // Read WHO_AM_I register for MPU-9250 |
jaybehandsome | 5:738285670edf | 934 | pc.printf("I AM 0x%x\n\r", whoami); bam.printf("I SHOULD BE 0x71\n\r"); |
jaybehandsome | 0:1e46c1a32764 | 935 | |
jaybehandsome | 0:1e46c1a32764 | 936 | if (whoami == 0x71) // WHO_AM_I should always be 0x68 |
jaybehandsome | 0:1e46c1a32764 | 937 | { |
jaybehandsome | 5:738285670edf | 938 | bam.printf("MPU9250 WHO_AM_I is 0x%x\n\r", whoami); |
jaybehandsome | 5:738285670edf | 939 | bam.printf("MPU9250 is online...\n\r"); |
jaybehandsome | 0:1e46c1a32764 | 940 | sprintf(buffer, "0x%x", whoami); |
jaybehandsome | 0:1e46c1a32764 | 941 | |
jaybehandsome | 0:1e46c1a32764 | 942 | wait(1); |
jaybehandsome | 0:1e46c1a32764 | 943 | |
jaybehandsome | 0:1e46c1a32764 | 944 | mpu9250.resetMPU9250(); // Reset registers to default in preparation for device calibration |
jaybehandsome | 0:1e46c1a32764 | 945 | mpu9250.MPU9250SelfTest(SelfTest); // Start by performing self test and reporting values |
jaybehandsome | 5:738285670edf | 946 | bam.printf("x-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[0]); |
jaybehandsome | 5:738285670edf | 947 | bam.printf("y-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[1]); |
jaybehandsome | 5:738285670edf | 948 | bam.printf("z-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[2]); |
jaybehandsome | 5:738285670edf | 949 | bam.printf("x-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[3]); |
jaybehandsome | 5:738285670edf | 950 | bam.printf("y-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[4]); |
jaybehandsome | 5:738285670edf | 951 | bam.printf("z-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[5]); |
jaybehandsome | 0:1e46c1a32764 | 952 | mpu9250.calibrateMPU9250(gyroBias, accelBias); // Calibrate gyro and accelerometers, load biases in bias registers |
jaybehandsome | 5:738285670edf | 953 | bam.printf("x gyro bias = %f\n\r", gyroBias[0]); |
jaybehandsome | 5:738285670edf | 954 | bam.printf("y gyro bias = %f\n\r", gyroBias[1]); |
jaybehandsome | 5:738285670edf | 955 | bam.printf("z gyro bias = %f\n\r", gyroBias[2]); |
jaybehandsome | 5:738285670edf | 956 | bam.printf("x accel bias = %f\n\r", accelBias[0]); |
jaybehandsome | 5:738285670edf | 957 | bam.printf("y accel bias = %f\n\r", accelBias[1]); |
jaybehandsome | 5:738285670edf | 958 | bam.printf("z accel bias = %f\n\r", accelBias[2]); |
jaybehandsome | 0:1e46c1a32764 | 959 | wait(2); |
jaybehandsome | 0:1e46c1a32764 | 960 | mpu9250.initMPU9250(); |
jaybehandsome | 5:738285670edf | 961 | bam.printf("MPU9250 initialized for active data mode....\n\r"); // Initialize device for active mode read of acclerometer, gyroscope, and temperature |
jaybehandsome | 0:1e46c1a32764 | 962 | mpu9250.initAK8963(magCalibration); |
jaybehandsome | 5:738285670edf | 963 | bam.printf("AK8963 initialized for active data mode....\n\r"); // Initialize device for active mode read of magnetometer |
jaybehandsome | 5:738285670edf | 964 | bam.printf("Accelerometer full-scale range = %f g\n\r", 2.0f*(float)(1<<Ascale)); |
jaybehandsome | 5:738285670edf | 965 | bam.printf("Gyroscope full-scale range = %f deg/s\n\r", 250.0f*(float)(1<<Gscale)); |
jaybehandsome | 5:738285670edf | 966 | if(Mscale == 0) bam.printf("Magnetometer resolution = 14 bits\n\r"); |
jaybehandsome | 5:738285670edf | 967 | if(Mscale == 1) bam.printf("Magnetometer resolution = 16 bits\n\r"); |
jaybehandsome | 5:738285670edf | 968 | if(Mmode == 2) bam.printf("Magnetometer ODR = 8 Hz\n\r"); |
jaybehandsome | 5:738285670edf | 969 | if(Mmode == 6) bam.printf("Magnetometer ODR = 100 Hz\n\r"); |
jaybehandsome | 0:1e46c1a32764 | 970 | wait(1); |
jaybehandsome | 0:1e46c1a32764 | 971 | } |
jaybehandsome | 0:1e46c1a32764 | 972 | else |
jaybehandsome | 0:1e46c1a32764 | 973 | { |
jaybehandsome | 5:738285670edf | 974 | bam.printf("Could not connect to MPU9250: \n\r"); |
jaybehandsome | 5:738285670edf | 975 | bam.printf("%#x \n", whoami); |
jaybehandsome | 0:1e46c1a32764 | 976 | |
jaybehandsome | 0:1e46c1a32764 | 977 | sprintf(buffer, "WHO_AM_I 0x%x", whoami); |
jaybehandsome | 0:1e46c1a32764 | 978 | |
jaybehandsome | 0:1e46c1a32764 | 979 | |
jaybehandsome | 0:1e46c1a32764 | 980 | while(1) ; // Loop forever if communication doesn't happen |
jaybehandsome | 0:1e46c1a32764 | 981 | } |
jaybehandsome | 0:1e46c1a32764 | 982 | |
jaybehandsome | 0:1e46c1a32764 | 983 | mpu9250.getAres(); // Get accelerometer sensitivity |
jaybehandsome | 0:1e46c1a32764 | 984 | mpu9250.getGres(); // Get gyro sensitivity |
jaybehandsome | 0:1e46c1a32764 | 985 | mpu9250.getMres(); // Get magnetometer sensitivity |
jaybehandsome | 6:1de63d5df56a | 986 | pc.printf("Accelerometer sensitivity is %f LSB/g \n\r", 1.0f/aRes); |
jaybehandsome | 6:1de63d5df56a | 987 | pc.printf("Gyroscope sensitivity is %f LSB/deg/s \n\r", 1.0f/gRes); |
jaybehandsome | 6:1de63d5df56a | 988 | pc.printf("Magnetometer sensitivity is %f LSB/G \n\r", 1.0f/mRes); |
jaybehandsome | 0:1e46c1a32764 | 989 | magbias[0] = +470.; // User environmental x-axis correction in milliGauss, should be automatically calculated |
jaybehandsome | 0:1e46c1a32764 | 990 | magbias[1] = +120.; // User environmental x-axis correction in milliGauss |
jaybehandsome | 0:1e46c1a32764 | 991 | magbias[2] = +125.; // User environmental x-axis correction in milliGauss |
jaybehandsome | 0:1e46c1a32764 | 992 | |
jaybehandsome | 0:1e46c1a32764 | 993 | while(1) { |
jaybehandsome | 0:1e46c1a32764 | 994 | |
jaybehandsome | 5:738285670edf | 995 | |
jaybehandsome | 0:1e46c1a32764 | 996 | // If intPin goes high, all data registers have new data |
jaybehandsome | 0:1e46c1a32764 | 997 | if(mpu9250.readByte(MPU9250_ADDRESS, INT_STATUS) & 0x01) { // On interrupt, check if data ready interrupt |
jaybehandsome | 0:1e46c1a32764 | 998 | |
jaybehandsome | 0:1e46c1a32764 | 999 | mpu9250.readGyroData(gyroCount); // Read the x/y/z adc values |
jaybehandsome | 0:1e46c1a32764 | 1000 | // Calculate the gyro value into actual degrees per second |
jaybehandsome | 0:1e46c1a32764 | 1001 | gx = (float)gyroCount[0]*gRes - gyroBias[0]; // get actual gyro value, this depends on scale being set |
jaybehandsome | 0:1e46c1a32764 | 1002 | gy = (float)gyroCount[1]*gRes - gyroBias[1]; |
jaybehandsome | 0:1e46c1a32764 | 1003 | gz = (float)gyroCount[2]*gRes - gyroBias[2]; |
jaybehandsome | 0:1e46c1a32764 | 1004 | |
jaybehandsome | 0:1e46c1a32764 | 1005 | mpu9250.MahonyQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f, my, mx, mz); |
jaybehandsome | 0:1e46c1a32764 | 1006 | |
jaybehandsome | 0:1e46c1a32764 | 1007 | // Serial print and/or display at 0.5 s rate independent of data rates |
jaybehandsome | 4:9cc307f25dc9 | 1008 | delt_t = t.read_us() - count; |
jaybehandsome | 4:9cc307f25dc9 | 1009 | if (delt_t > 1) { // update LCD once per half-second independent of read rate |
jaybehandsome | 6:1de63d5df56a | 1010 | |
jaybehandsome | 6:1de63d5df56a | 1011 | x = 1.2; |
jaybehandsome | 4:9cc307f25dc9 | 1012 | posA += (gz*delt_t*x/1000000); |
jaybehandsome | 4:9cc307f25dc9 | 1013 | posA = fmod(posA,360); |
jaybehandsome | 4:9cc307f25dc9 | 1014 | posB = fmod(posA + 240,360); |
jaybehandsome | 4:9cc307f25dc9 | 1015 | posC = fmod(posA + 120,360); |
jaybehandsome | 6:1de63d5df56a | 1016 | count = t.read_us(); |
jaybehandsome | 6:1de63d5df56a | 1017 | //Text('O',posA,posB,posC,0); |
jaybehandsome | 6:1de63d5df56a | 1018 | // Text('B',posA,posB,posC,1); |
jaybehandsome | 6:1de63d5df56a | 1019 | // Text('I',posA,posB,posC,2); |
jaybehandsome | 6:1de63d5df56a | 1020 | // Text('F',posA,posB,posC,3); |
jaybehandsome | 6:1de63d5df56a | 1021 | // Text(' ',posA,posB,posC,4); |
jaybehandsome | 6:1de63d5df56a | 1022 | // Text(' ',posA,posB,posC,5); |
jaybehandsome | 6:1de63d5df56a | 1023 | |
jaybehandsome | 5:738285670edf | 1024 | if (mode == 1) |
jaybehandsome | 5:738285670edf | 1025 | { |
jaybehandsome | 6:1de63d5df56a | 1026 | Velocity(v,posA,posB,posC); |
jaybehandsome | 5:738285670edf | 1027 | } |
jaybehandsome | 6:1de63d5df56a | 1028 | else if (mode == 2) |
jaybehandsome | 6:1de63d5df56a | 1029 | { |
jaybehandsome | 6:1de63d5df56a | 1030 | Text((char)word[0],posA,posB,posC,5); |
jaybehandsome | 6:1de63d5df56a | 1031 | Text((char)word[1],posA,posB,posC,4); |
jaybehandsome | 6:1de63d5df56a | 1032 | Text((char)word[2],posA,posB,posC,3); |
jaybehandsome | 6:1de63d5df56a | 1033 | Text((char)word[3],posA,posB,posC,2); |
jaybehandsome | 6:1de63d5df56a | 1034 | Text((char)word[4],posA,posB,posC,1); |
jaybehandsome | 6:1de63d5df56a | 1035 | Text((char)word[5],posA,posB,posC,0); |
jaybehandsome | 3:46cc9d386ff4 | 1036 | } |
jaybehandsome | 4:9cc307f25dc9 | 1037 | |
jaybehandsome | 0:1e46c1a32764 | 1038 | } |
jaybehandsome | 5:738285670edf | 1039 | delt_t2 = t.read_us() - count2; |
jaybehandsome | 5:738285670edf | 1040 | if (delt_t2 >= 1000000) |
jaybehandsome | 5:738285670edf | 1041 | { |
jaybehandsome | 5:738285670edf | 1042 | v = (gz*x*PI*0.35*3600)/(180*1000*100); |
jaybehandsome | 5:738285670edf | 1043 | pc.printf("%0.1f",v); |
jaybehandsome | 5:738285670edf | 1044 | count2 = t.read_us(); |
jaybehandsome | 5:738285670edf | 1045 | } |
jaybehandsome | 6:1de63d5df56a | 1046 | |
jaybehandsome | 5:738285670edf | 1047 | if (pc.readable()) |
jaybehandsome | 6:1de63d5df56a | 1048 | |
jaybehandsome | 5:738285670edf | 1049 | { |
jaybehandsome | 5:738285670edf | 1050 | cmode = pc.getc(); |
jaybehandsome | 6:1de63d5df56a | 1051 | switch(cmode) |
jaybehandsome | 5:738285670edf | 1052 | { |
jaybehandsome | 6:1de63d5df56a | 1053 | case '&': |
jaybehandsome | 6:1de63d5df56a | 1054 | word.clear(); |
jaybehandsome | 6:1de63d5df56a | 1055 | break; |
jaybehandsome | 6:1de63d5df56a | 1056 | |
jaybehandsome | 5:738285670edf | 1057 | case '?': |
jaybehandsome | 5:738285670edf | 1058 | mode = 1; |
jaybehandsome | 5:738285670edf | 1059 | break; |
jaybehandsome | 5:738285670edf | 1060 | |
jaybehandsome | 6:1de63d5df56a | 1061 | case '!': |
jaybehandsome | 5:738285670edf | 1062 | mode = 2; |
jaybehandsome | 5:738285670edf | 1063 | break; |
jaybehandsome | 6:1de63d5df56a | 1064 | |
jaybehandsome | 6:1de63d5df56a | 1065 | default: |
jaybehandsome | 6:1de63d5df56a | 1066 | word += cmode; |
jaybehandsome | 5:738285670edf | 1067 | } |
jaybehandsome | 6:1de63d5df56a | 1068 | // bam.printf("%c %s %d\n",cmode, word, word.length()); |
jaybehandsome | 5:738285670edf | 1069 | } |
jaybehandsome | 0:1e46c1a32764 | 1070 | } |
jaybehandsome | 3:46cc9d386ff4 | 1071 | |
jaybehandsome | 4:9cc307f25dc9 | 1072 | |
jaybehandsome | 4:9cc307f25dc9 | 1073 | } |
jaybehandsome | 0:1e46c1a32764 | 1074 | } |