Project bike / Mbed 2 deprecated mpu9250bam2

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?

UserRevisionLine numberNew 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 }