mpu9250bam2 - bamlor nuttymaisuay

Project bike » Code » mpu9250bam2

Project bike / Mbed 2 deprecated mpu9250bam2

bamlor nuttymaisuay

Dependencies: mbed

main.cpp@7:61c1f10bf484, 2017-12-12 (annotated)

Committer:: jaybehandsome
Date:: Tue Dec 12 02:36:58 2017 +0000
Revision:: 7:61c1f10bf484
Parent:: 6:1de63d5df56a

full scale

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	7:61c1f10bf484	753	else if(posC > 40+n && posC < 50+n ) { C = 0x79; }
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	7:61c1f10bf484	845	void Number(char text,float posA,float posB,float posC,int i)
jaybehandsome	7:61c1f10bf484	846	{
jaybehandsome	7:61c1f10bf484	847	int n = i*50;
jaybehandsome	7:61c1f10bf484	848	if (i ==1 \|\| i ==2)
jaybehandsome	7:61c1f10bf484	849	{n=(i*50)+15;}
jaybehandsome	7:61c1f10bf484	850	if (text == '0'){
jaybehandsome	7:61c1f10bf484	851	if (posA > 0+n && posA < 9+n) { A = 0x7F; }
jaybehandsome	7:61c1f10bf484	852	else if(posA > 9+n && posA < 18+n ) { A = 0x41; }
jaybehandsome	7:61c1f10bf484	853	else if(posA > 18+n && posA < 27+n ) { A = 0x41; }
jaybehandsome	7:61c1f10bf484	854	else if(posA > 27+n && posA < 36+n ) { A = 0x41; }
jaybehandsome	7:61c1f10bf484	855	else if(posA > 36+n && posA < 45+n ) { A = 0x7F; }
jaybehandsome	7:61c1f10bf484	856	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	857
jaybehandsome	7:61c1f10bf484	858	if (posB > 0+n && posB < 9+n) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	859	else if(posB > 9+n && posB < 18+n ) { B = 0x41; }
jaybehandsome	7:61c1f10bf484	860	else if(posB > 18+n && posB < 27+n ) { B = 0x41; }
jaybehandsome	7:61c1f10bf484	861	else if(posB > 27+n && posB < 36+n ) { B = 0x41; }
jaybehandsome	7:61c1f10bf484	862	else if(posB > 36+n && posB < 45+n ) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	863	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	864
jaybehandsome	7:61c1f10bf484	865	if (posC > 0+n && posC < 9+n) { C = 0x7F; }
jaybehandsome	7:61c1f10bf484	866	else if(posC > 9+n && posC < 18+n ) { C = 0x41; }
jaybehandsome	7:61c1f10bf484	867	else if(posC > 18+n && posC < 27+n ) { C = 0x41; }
jaybehandsome	7:61c1f10bf484	868	else if(posC > 27+n && posC < 36+n ) { C = 0x41; }
jaybehandsome	7:61c1f10bf484	869	else if(posC > 36+n && posC < 45+n ) { C = 0x7F; }
jaybehandsome	7:61c1f10bf484	870	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	871	}
jaybehandsome	7:61c1f10bf484	872	if (text == '1'){
jaybehandsome	7:61c1f10bf484	873	if (posA > 0+n && posA < 9+n) { A = 0x01; }
jaybehandsome	7:61c1f10bf484	874	else if(posA > 9+n && posA < 18+n ) { A = 0x01; }
jaybehandsome	7:61c1f10bf484	875	else if(posA > 18+n && posA < 27+n ) { A = 0x7F; }
jaybehandsome	7:61c1f10bf484	876	else if(posA > 27+n && posA < 36+n ) { A = 0x21; }
jaybehandsome	7:61c1f10bf484	877	else if(posA > 36+n && posA < 45+n ) { A = 0x21; }
jaybehandsome	7:61c1f10bf484	878	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	879
jaybehandsome	7:61c1f10bf484	880	if (posB > 0+n && posB < 9+n) { B = 0x01; }
jaybehandsome	7:61c1f10bf484	881	else if(posB > 9+n && posB < 18+n ) { B = 0x01; }
jaybehandsome	7:61c1f10bf484	882	else if(posB > 18+n && posB < 27+n ) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	883	else if(posB > 27+n && posB < 36+n ) { B = 0x21; }
jaybehandsome	7:61c1f10bf484	884	else if(posB > 36+n && posB < 45+n ) { B = 0x21; }
jaybehandsome	7:61c1f10bf484	885	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	886
jaybehandsome	7:61c1f10bf484	887	if (posC > 0+n && posC < 9+n) { C = 0x01; }
jaybehandsome	7:61c1f10bf484	888	else if(posC > 9+n && posC < 18+n ) { C = 0x01; }
jaybehandsome	7:61c1f10bf484	889	else if(posC > 18+n && posC < 27+n ) { C = 0x7F; }
jaybehandsome	7:61c1f10bf484	890	else if(posC > 27+n && posC < 36+n ) { C = 0x21; }
jaybehandsome	7:61c1f10bf484	891	else if(posC > 36+n && posC < 45+n ) { C = 0x21; }
jaybehandsome	7:61c1f10bf484	892	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	893	}
jaybehandsome	7:61c1f10bf484	894	if (text == '2'){
jaybehandsome	7:61c1f10bf484	895	if (posA > 0+n && posA < 9+n) { A = 0x21; }
jaybehandsome	7:61c1f10bf484	896	else if(posA > 9+n && posA < 18+n ) { A = 0x51; }
jaybehandsome	7:61c1f10bf484	897	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	898	else if(posA > 27+n && posA < 36+n ) { A = 0x45; }
jaybehandsome	7:61c1f10bf484	899	else if(posA > 36+n && posA < 45+n ) { A = 0x23; }
jaybehandsome	7:61c1f10bf484	900	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	901
jaybehandsome	7:61c1f10bf484	902	if (posB > 0+n && posB < 9+n) { B = 0x21; }
jaybehandsome	7:61c1f10bf484	903	else if(posB > 9+n && posB < 18+n ) { B = 0x51; }
jaybehandsome	7:61c1f10bf484	904	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	905	else if(posB > 27+n && posB < 36+n ) { B = 0x45; }
jaybehandsome	7:61c1f10bf484	906	else if(posB > 36+n && posB < 45+n ) { B = 0x23; }
jaybehandsome	7:61c1f10bf484	907	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	908
jaybehandsome	7:61c1f10bf484	909	if (posC > 0+n && posC < 9+n) { C = 0x21; }
jaybehandsome	7:61c1f10bf484	910	else if(posC > 9+n && posC < 18+n ) { C = 0x51; }
jaybehandsome	7:61c1f10bf484	911	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	912	else if(posC > 27+n && posC < 36+n ) { C = 0x45; }
jaybehandsome	7:61c1f10bf484	913	else if(posC > 36+n && posC < 45+n ) { C = 0x23; }
jaybehandsome	7:61c1f10bf484	914	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	915	}
jaybehandsome	7:61c1f10bf484	916	if (text == '3'){
jaybehandsome	7:61c1f10bf484	917	if (posA > 0+n && posA < 9+n) { A = 0x36; }
jaybehandsome	7:61c1f10bf484	918	else if(posA > 9+n && posA < 18+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	919	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	920	else if(posA > 27+n && posA < 36+n ) { A = 0x41; }
jaybehandsome	7:61c1f10bf484	921	else if(posA > 36+n && posA < 45+n ) { A = 0x22; }
jaybehandsome	7:61c1f10bf484	922	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	923
jaybehandsome	7:61c1f10bf484	924	if (posB > 0+n && posB < 9+n) { B = 0x36; }
jaybehandsome	7:61c1f10bf484	925	else if(posB > 9+n && posB < 18+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	926	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	927	else if(posB > 27+n && posB < 36+n ) { B = 0x41; }
jaybehandsome	7:61c1f10bf484	928	else if(posB > 36+n && posB < 45+n ) { B = 0x22; }
jaybehandsome	7:61c1f10bf484	929	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	930
jaybehandsome	7:61c1f10bf484	931	if (posC > 0+n && posC < 9+n) { C = 0x36; }
jaybehandsome	7:61c1f10bf484	932	else if(posC > 9+n && posC < 18+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	933	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	934	else if(posC > 27+n && posC < 36+n ) { C = 0x41; }
jaybehandsome	7:61c1f10bf484	935	else if(posC > 36+n && posC < 45+n ) { C = 0x22; }
jaybehandsome	7:61c1f10bf484	936	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	937	}
jaybehandsome	7:61c1f10bf484	938	if (text == '4'){
jaybehandsome	7:61c1f10bf484	939	if (posA > 0+n && posA < 9+n) { A = 0x04; }
jaybehandsome	7:61c1f10bf484	940	else if(posA > 9+n && posA < 18+n ) { A = 0x1F; }
jaybehandsome	7:61c1f10bf484	941	else if(posA > 18+n && posA < 27+n ) { A = 0x04; }
jaybehandsome	7:61c1f10bf484	942	else if(posA > 27+n && posA < 36+n ) { A = 0x04; }
jaybehandsome	7:61c1f10bf484	943	else if(posA > 36+n && posA < 45+n ) { A = 0x7C; }
jaybehandsome	7:61c1f10bf484	944	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	945
jaybehandsome	7:61c1f10bf484	946	if (posB > 0+n && posB < 9+n) { B = 0x04; }
jaybehandsome	7:61c1f10bf484	947	else if(posB > 9+n && posB < 18+n ) { B = 0x1F; }
jaybehandsome	7:61c1f10bf484	948	else if(posB > 18+n && posB < 27+n ) { B = 0x04; }
jaybehandsome	7:61c1f10bf484	949	else if(posB > 27+n && posB < 36+n ) { B = 0x04; }
jaybehandsome	7:61c1f10bf484	950	else if(posB > 36+n && posB < 45+n ) { B = 0x7C; }
jaybehandsome	7:61c1f10bf484	951	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	952
jaybehandsome	7:61c1f10bf484	953	if (posC > 0+n && posC < 9+n) { C = 0x04; }
jaybehandsome	7:61c1f10bf484	954	else if(posC > 9+n && posC < 18+n ) { C = 0x1F; }
jaybehandsome	7:61c1f10bf484	955	else if(posC > 18+n && posC < 27+n ) { C = 0x04; }
jaybehandsome	7:61c1f10bf484	956	else if(posC > 27+n && posC < 36+n ) { C = 0x04; }
jaybehandsome	7:61c1f10bf484	957	else if(posC > 36+n && posC < 45+n ) { C = 0x7C; }
jaybehandsome	7:61c1f10bf484	958	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	959	}
jaybehandsome	7:61c1f10bf484	960	if (text == '5'){
jaybehandsome	7:61c1f10bf484	961	if (posA > 0+n && posA < 9+n) { A = 0x46; }
jaybehandsome	7:61c1f10bf484	962	else if(posA > 9+n && posA < 18+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	963	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	964	else if(posA > 27+n && posA < 36+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	965	else if(posA > 36+n && posA < 45+n ) { A = 0x79; }
jaybehandsome	7:61c1f10bf484	966	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	967
jaybehandsome	7:61c1f10bf484	968	if (posB > 0+n && posB < 9+n) { B = 0x46; }
jaybehandsome	7:61c1f10bf484	969	else if(posB > 9+n && posB < 18+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	970	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	971	else if(posB > 27+n && posB < 36+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	972	else if(posB > 36+n && posB < 45+n ) { B = 0x79; }
jaybehandsome	7:61c1f10bf484	973	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	974
jaybehandsome	7:61c1f10bf484	975	if (posC > 0+n && posC < 9+n) { C = 0x46; }
jaybehandsome	7:61c1f10bf484	976	else if(posC > 9+n && posC < 18+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	977	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	978	else if(posC > 27+n && posC < 36+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	979	else if(posC > 36+n && posC < 45+n ) { C = 0x79; }
jaybehandsome	7:61c1f10bf484	980	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	981	}
jaybehandsome	7:61c1f10bf484	982	if (text == '6'){
jaybehandsome	7:61c1f10bf484	983	if (posA > 0+n && posA < 9+n) { A = 0x26; }
jaybehandsome	7:61c1f10bf484	984	else if(posA > 9+n && posA < 18+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	985	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	986	else if(posA > 27+n && posA < 36+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	987	else if(posA > 36+n && posA < 45+n ) { A = 0x3E; }
jaybehandsome	7:61c1f10bf484	988	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	989
jaybehandsome	7:61c1f10bf484	990	if (posB > 0+n && posB < 9+n) { B = 0x26; }
jaybehandsome	7:61c1f10bf484	991	else if(posB > 9+n && posB < 18+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	992	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	993	else if(posB > 27+n && posB < 36+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	994	else if(posB > 36+n && posB < 45+n ) { B = 0x3E; }
jaybehandsome	7:61c1f10bf484	995	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	996
jaybehandsome	7:61c1f10bf484	997	if (posC > 0+n && posC < 9+n) { C = 0x26; }
jaybehandsome	7:61c1f10bf484	998	else if(posC > 9+n && posC < 18+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	999	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1000	else if(posC > 27+n && posC < 36+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1001	else if(posC > 36+n && posC < 45+n ) { C = 0x3E; }
jaybehandsome	7:61c1f10bf484	1002	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1003	}
jaybehandsome	7:61c1f10bf484	1004	if (text == '7'){
jaybehandsome	7:61c1f10bf484	1005	if (posA > 0+n && posA < 9+n) { A = 0x60; }
jaybehandsome	7:61c1f10bf484	1006	else if(posA > 9+n && posA < 18+n ) { A = 0x50; }
jaybehandsome	7:61c1f10bf484	1007	else if(posA > 18+n && posA < 27+n ) { A = 0x47; }
jaybehandsome	7:61c1f10bf484	1008	else if(posA > 27+n && posA < 36+n ) { A = 0x40; }
jaybehandsome	7:61c1f10bf484	1009	else if(posA > 36+n && posA < 45+n ) { A = 0x40; }
jaybehandsome	7:61c1f10bf484	1010	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	1011
jaybehandsome	7:61c1f10bf484	1012	if (posB > 0+n && posB < 9+n) { B = 0x60; }
jaybehandsome	7:61c1f10bf484	1013	else if(posB > 9+n && posB < 18+n ) { B = 0x50; }
jaybehandsome	7:61c1f10bf484	1014	else if(posB > 18+n && posB < 27+n ) { B = 0x47; }
jaybehandsome	7:61c1f10bf484	1015	else if(posB > 27+n && posB < 36+n ) { B = 0x40; }
jaybehandsome	7:61c1f10bf484	1016	else if(posB > 36+n && posB < 45+n ) { B = 0x40; }
jaybehandsome	7:61c1f10bf484	1017	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	1018
jaybehandsome	7:61c1f10bf484	1019	if (posC > 0+n && posC < 9+n) { C = 0x60; }
jaybehandsome	7:61c1f10bf484	1020	else if(posC > 9+n && posC < 18+n ) { C = 0x50; }
jaybehandsome	7:61c1f10bf484	1021	else if(posC > 18+n && posC < 27+n ) { C = 0x47; }
jaybehandsome	7:61c1f10bf484	1022	else if(posC > 27+n && posC < 36+n ) { C = 0x40; }
jaybehandsome	7:61c1f10bf484	1023	else if(posC > 36+n && posC < 45+n ) { C = 0x40; }
jaybehandsome	7:61c1f10bf484	1024	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1025	}
jaybehandsome	7:61c1f10bf484	1026	if (text == '8'){
jaybehandsome	7:61c1f10bf484	1027	if (posA > 0+n && posA < 9+n) { A = 0x36; }
jaybehandsome	7:61c1f10bf484	1028	else if(posA > 9+n && posA < 18+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1029	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1030	else if(posA > 27+n && posA < 36+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1031	else if(posA > 36+n && posA < 45+n ) { A = 0x36; }
jaybehandsome	7:61c1f10bf484	1032	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	1033
jaybehandsome	7:61c1f10bf484	1034	if (posB > 0+n && posB < 9+n) { B = 0x36; }
jaybehandsome	7:61c1f10bf484	1035	else if(posB > 9+n && posB < 18+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1036	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1037	else if(posB > 27+n && posB < 36+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1038	else if(posB > 36+n && posB < 45+n ) { B = 0x36; }
jaybehandsome	7:61c1f10bf484	1039	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	1040
jaybehandsome	7:61c1f10bf484	1041	if (posC > 0+n && posC < 9+n) { C = 0x36; }
jaybehandsome	7:61c1f10bf484	1042	else if(posC > 9+n && posC < 18+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1043	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1044	else if(posC > 27+n && posC < 36+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1045	else if(posC > 36+n && posC < 45+n ) { C = 0x36; }
jaybehandsome	7:61c1f10bf484	1046	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1047	}
jaybehandsome	7:61c1f10bf484	1048	if (text == '9'){
jaybehandsome	7:61c1f10bf484	1049	if (posA > 0+n && posA < 9+n) { A = 0x3E; }
jaybehandsome	7:61c1f10bf484	1050	else if(posA > 9+n && posA < 18+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1051	else if(posA > 18+n && posA < 27+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1052	else if(posA > 27+n && posA < 36+n ) { A = 0x49; }
jaybehandsome	7:61c1f10bf484	1053	else if(posA > 36+n && posA < 45+n ) { A = 0x32; }
jaybehandsome	7:61c1f10bf484	1054	else if(posA > 45+n && posA < 50+n ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	1055
jaybehandsome	7:61c1f10bf484	1056	if (posB > 0+n && posB < 9+n) { B = 0x3E; }
jaybehandsome	7:61c1f10bf484	1057	else if(posB > 9+n && posB < 18+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1058	else if(posB > 18+n && posB < 27+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1059	else if(posB > 27+n && posB < 36+n ) { B = 0x49; }
jaybehandsome	7:61c1f10bf484	1060	else if(posB > 36+n && posB < 45+n ) { B = 0x32; }
jaybehandsome	7:61c1f10bf484	1061	else if(posB > 45+n && posB < 50+n ) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	1062
jaybehandsome	7:61c1f10bf484	1063	if (posC > 0+n && posC < 9+n) { C = 0x3E; }
jaybehandsome	7:61c1f10bf484	1064	else if(posC > 9+n && posC < 18+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1065	else if(posC > 18+n && posC < 27+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1066	else if(posC > 27+n && posC < 36+n ) { C = 0x49; }
jaybehandsome	7:61c1f10bf484	1067	else if(posC > 36+n && posC < 45+n ) { C = 0x32; }
jaybehandsome	7:61c1f10bf484	1068	else if(posC > 45+n && posC < 50+n ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1069	}
jaybehandsome	7:61c1f10bf484	1070	}
jaybehandsome	6:1de63d5df56a	1071
jaybehandsome	7:61c1f10bf484	1072	void Velocity(float v ,float posA,float posB,float posC){
jaybehandsome	6:1de63d5df56a	1073	char value[3] ;
jaybehandsome	7:61c1f10bf484	1074	float w = v*10;
jaybehandsome	7:61c1f10bf484	1075	sprintf(value ,"%f",w);
jaybehandsome	7:61c1f10bf484	1076	if (v<10){value[2] = value[1];value[1]=value[0];value[0] = 0;}
jaybehandsome	7:61c1f10bf484	1077	if (posA > 180 && posA < 190) { A = 0x0F; }
jaybehandsome	7:61c1f10bf484	1078	else if(posA > 190 && posA < 200 ) { A = 0x08; }
jaybehandsome	7:61c1f10bf484	1079	else if(posA > 200 && posA < 210 ) { A = 0x7F; }
jaybehandsome	7:61c1f10bf484	1080	else if(posA > 210 && posA < 220 ) { A = 0x03; }
jaybehandsome	7:61c1f10bf484	1081	else if(posA > 220 && posA < 230 ) { A = 0x0C; }
jaybehandsome	7:61c1f10bf484	1082	else if(posA > 230 && posA < 240 ) { A = 0x03; }
jaybehandsome	7:61c1f10bf484	1083	else if(posA > 240 && posA < 250 ) { A = 0x0F; }
jaybehandsome	7:61c1f10bf484	1084	else if(posA > 250 && posA < 260 ) { A = 0x08; }
jaybehandsome	7:61c1f10bf484	1085	else if(posA > 260 && posA < 270 ) { A = 0x04; }
jaybehandsome	7:61c1f10bf484	1086	else if(posA > 270 && posA < 280 ) { A = 0x08; }
jaybehandsome	7:61c1f10bf484	1087	else if(posA > 280 && posA < 290 ) { A = 0x0F; }
jaybehandsome	7:61c1f10bf484	1088	else if(posA > 290 && posA < 300 ) { A = 0x11; }
jaybehandsome	7:61c1f10bf484	1089	else if(posA > 300 && posA < 310 ) { A = 0x0A; }
jaybehandsome	7:61c1f10bf484	1090	else if(posA > 310 && posA < 320 ) { A = 0x04; }
jaybehandsome	7:61c1f10bf484	1091	else if(posA > 320 && posA < 330 ) { A = 0x7F; }
jaybehandsome	7:61c1f10bf484	1092	else if(posA > 330 && posA < 340 ) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	1093
jaybehandsome	6:1de63d5df56a	1094
jaybehandsome	7:61c1f10bf484	1095
jaybehandsome	7:61c1f10bf484	1096	if (posB > 180 && posB < 190) { B = 0x0F; }
jaybehandsome	7:61c1f10bf484	1097	else if(posB > 190 && posB < 200 ) { B = 0x08; }
jaybehandsome	7:61c1f10bf484	1098	else if(posB > 200 && posB < 210 ) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	1099	else if(posB > 210 && posB < 220 ) { B = 0x03; }
jaybehandsome	7:61c1f10bf484	1100	else if(posB > 220 && posB < 230 ) { B = 0x0C; }
jaybehandsome	7:61c1f10bf484	1101	else if(posB > 230 && posB < 240 ) { B = 0x03; }
jaybehandsome	7:61c1f10bf484	1102	else if(posB > 240 && posB < 250 ) { B = 0x0F; }
jaybehandsome	7:61c1f10bf484	1103	else if(posB > 250 && posB < 260 ) { B = 0x08; }
jaybehandsome	7:61c1f10bf484	1104	else if(posB > 260 && posB < 270 ) { B = 0x04; }
jaybehandsome	7:61c1f10bf484	1105	else if(posB > 270 && posB < 280 ) { B = 0x08; }
jaybehandsome	7:61c1f10bf484	1106	else if(posB > 280 && posB < 290 ) { B = 0x0F; }
jaybehandsome	7:61c1f10bf484	1107	else if(posB > 290 && posB < 300 ) { B = 0x11; }
jaybehandsome	7:61c1f10bf484	1108	else if(posB > 300 && posB < 310 ) { B = 0x0A; }
jaybehandsome	7:61c1f10bf484	1109	else if(posB > 310 && posB < 320 ) { B = 0x04; }
jaybehandsome	7:61c1f10bf484	1110	else if(posB > 320 && posB < 330 ) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	1111	else if(posB > 330 && posB < 340 ) { B = 0x7F; }
jaybehandsome	7:61c1f10bf484	1112	else if(posB > 340 && posB < 350 ) { B = 0x00; }
jaybehandsome	6:1de63d5df56a	1113
jaybehandsome	7:61c1f10bf484	1114	if (posC > 180 && posC < 190) { C = 0x0F; }
jaybehandsome	7:61c1f10bf484	1115	else if(posC > 190 && posC < 200 ) { C = 0x08; }
jaybehandsome	7:61c1f10bf484	1116	else if(posC > 200 && posC < 210 ) { C = 0x7F; }
jaybehandsome	7:61c1f10bf484	1117	else if(posC > 210 && posC < 220 ) { C = 0x03; }
jaybehandsome	7:61c1f10bf484	1118	else if(posC > 220 && posC < 230 ) { C = 0x0C; }
jaybehandsome	7:61c1f10bf484	1119	else if(posC > 230 && posC < 240 ) { C = 0x03; }
jaybehandsome	7:61c1f10bf484	1120	else if(posC > 240 && posC < 250 ) { C = 0x0F; }
jaybehandsome	7:61c1f10bf484	1121	else if(posC > 250 && posC < 260 ) { C = 0x08; }
jaybehandsome	7:61c1f10bf484	1122	else if(posC > 260 && posC < 270 ) { C = 0x04; }
jaybehandsome	7:61c1f10bf484	1123	else if(posC > 270 && posC < 280 ) { C = 0x08; }
jaybehandsome	7:61c1f10bf484	1124	else if(posC > 280 && posC < 290 ) { C = 0x0F; }
jaybehandsome	7:61c1f10bf484	1125	else if(posC > 290 && posC < 300 ) { C = 0x11; }
jaybehandsome	7:61c1f10bf484	1126	else if(posC > 300 && posC < 310 ) { C = 0x0A; }
jaybehandsome	7:61c1f10bf484	1127	else if(posC > 310 && posC < 320 ) { C = 0x04; }
jaybehandsome	7:61c1f10bf484	1128	else if(posC > 320 && posC < 330 ) { C = 0x7F; }
jaybehandsome	7:61c1f10bf484	1129	else if(posC > 330 && posC < 340 ) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1130
jaybehandsome	7:61c1f10bf484	1131	if (posA > 50 && posA < 60) { A = 0x01; }
jaybehandsome	7:61c1f10bf484	1132	else if (posA > 60 && posA < 65) { A = 0x00; }
jaybehandsome	7:61c1f10bf484	1133	if (posB > 50 && posB < 60) { B = 0x01; }
jaybehandsome	7:61c1f10bf484	1134	else if (posB > 60 && posB < 65) { B = 0x00; }
jaybehandsome	7:61c1f10bf484	1135	if (posC > 50 && posC < 60) { C = 0x01; }
jaybehandsome	7:61c1f10bf484	1136	else if (posC > 60 && posC < 65) { C = 0x00; }
jaybehandsome	7:61c1f10bf484	1137	Number(value[2],posA,posB,posC,0);
jaybehandsome	7:61c1f10bf484	1138	Number(value[1],posA,posB,posC,1);
jaybehandsome	7:61c1f10bf484	1139	Number(value[0],posA,posB,posC,2);
jaybehandsome	7:61c1f10bf484	1140	}
jaybehandsome	7:61c1f10bf484	1141
jaybehandsome	7:61c1f10bf484	1142
jaybehandsome	7:61c1f10bf484	1143
jaybehandsome	6:1de63d5df56a	1144
jaybehandsome	5:738285670edf	1145	float posA = 0,posB,posC;
jaybehandsome	6:1de63d5df56a	1146
jaybehandsome	6:1de63d5df56a	1147
jaybehandsome	6:1de63d5df56a	1148
jaybehandsome	6:1de63d5df56a	1149
jaybehandsome	6:1de63d5df56a	1150
jaybehandsome	6:1de63d5df56a	1151
jaybehandsome	6:1de63d5df56a	1152
jaybehandsome	6:1de63d5df56a	1153
jaybehandsome	6:1de63d5df56a	1154
jaybehandsome	0:1e46c1a32764	1155	int main()
jaybehandsome	0:1e46c1a32764	1156	{
jaybehandsome	6:1de63d5df56a	1157	A = 0;
jaybehandsome	6:1de63d5df56a	1158	B = 0;
jaybehandsome	6:1de63d5df56a	1159	C = 0;
jaybehandsome	5:738285670edf	1160	mode = 0;
jaybehandsome	5:738285670edf	1161	pc.baud(38400);
jaybehandsome	0:1e46c1a32764	1162	//Set up I2C
jaybehandsome	0:1e46c1a32764	1163	i2c.frequency(400000); // use fast (400 kHz) I2C
jaybehandsome	0:1e46c1a32764	1164
jaybehandsome	5:738285670edf	1165	bam.printf("CPU SystemCoreClock is %d Hz\r\n", SystemCoreClock);
jaybehandsome	0:1e46c1a32764	1166
jaybehandsome	0:1e46c1a32764	1167	t.start();
jaybehandsome	0:1e46c1a32764	1168
jaybehandsome	0:1e46c1a32764	1169
jaybehandsome	0:1e46c1a32764	1170	// Read the WHO_AM_I register, this is a good test of communication
jaybehandsome	0:1e46c1a32764	1171	uint8_t whoami = mpu9250.readByte(MPU9250_ADDRESS, WHO_AM_I_MPU9250); // Read WHO_AM_I register for MPU-9250
jaybehandsome	5:738285670edf	1172	pc.printf("I AM 0x%x\n\r", whoami); bam.printf("I SHOULD BE 0x71\n\r");
jaybehandsome	0:1e46c1a32764	1173
jaybehandsome	0:1e46c1a32764	1174	if (whoami == 0x71) // WHO_AM_I should always be 0x68
jaybehandsome	0:1e46c1a32764	1175	{
jaybehandsome	5:738285670edf	1176	bam.printf("MPU9250 WHO_AM_I is 0x%x\n\r", whoami);
jaybehandsome	5:738285670edf	1177	bam.printf("MPU9250 is online...\n\r");
jaybehandsome	0:1e46c1a32764	1178	sprintf(buffer, "0x%x", whoami);
jaybehandsome	0:1e46c1a32764	1179
jaybehandsome	0:1e46c1a32764	1180	wait(1);
jaybehandsome	0:1e46c1a32764	1181
jaybehandsome	0:1e46c1a32764	1182	mpu9250.resetMPU9250(); // Reset registers to default in preparation for device calibration
jaybehandsome	0:1e46c1a32764	1183	mpu9250.MPU9250SelfTest(SelfTest); // Start by performing self test and reporting values
jaybehandsome	5:738285670edf	1184	bam.printf("x-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[0]);
jaybehandsome	5:738285670edf	1185	bam.printf("y-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[1]);
jaybehandsome	5:738285670edf	1186	bam.printf("z-axis self test: acceleration trim within : %f % of factory value\n\r", SelfTest[2]);
jaybehandsome	5:738285670edf	1187	bam.printf("x-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[3]);
jaybehandsome	5:738285670edf	1188	bam.printf("y-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[4]);
jaybehandsome	5:738285670edf	1189	bam.printf("z-axis self test: gyration trim within : %f % of factory value\n\r", SelfTest[5]);
jaybehandsome	0:1e46c1a32764	1190	mpu9250.calibrateMPU9250(gyroBias, accelBias); // Calibrate gyro and accelerometers, load biases in bias registers
jaybehandsome	5:738285670edf	1191	bam.printf("x gyro bias = %f\n\r", gyroBias[0]);
jaybehandsome	5:738285670edf	1192	bam.printf("y gyro bias = %f\n\r", gyroBias[1]);
jaybehandsome	5:738285670edf	1193	bam.printf("z gyro bias = %f\n\r", gyroBias[2]);
jaybehandsome	5:738285670edf	1194	bam.printf("x accel bias = %f\n\r", accelBias[0]);
jaybehandsome	5:738285670edf	1195	bam.printf("y accel bias = %f\n\r", accelBias[1]);
jaybehandsome	5:738285670edf	1196	bam.printf("z accel bias = %f\n\r", accelBias[2]);
jaybehandsome	0:1e46c1a32764	1197	wait(2);
jaybehandsome	0:1e46c1a32764	1198	mpu9250.initMPU9250();
jaybehandsome	5:738285670edf	1199	bam.printf("MPU9250 initialized for active data mode....\n\r"); // Initialize device for active mode read of acclerometer, gyroscope, and temperature
jaybehandsome	0:1e46c1a32764	1200	mpu9250.initAK8963(magCalibration);
jaybehandsome	5:738285670edf	1201	bam.printf("AK8963 initialized for active data mode....\n\r"); // Initialize device for active mode read of magnetometer
jaybehandsome	5:738285670edf	1202	bam.printf("Accelerometer full-scale range = %f g\n\r", 2.0f*(float)(1<<Ascale));
jaybehandsome	5:738285670edf	1203	bam.printf("Gyroscope full-scale range = %f deg/s\n\r", 250.0f*(float)(1<<Gscale));
jaybehandsome	5:738285670edf	1204	if(Mscale == 0) bam.printf("Magnetometer resolution = 14 bits\n\r");
jaybehandsome	5:738285670edf	1205	if(Mscale == 1) bam.printf("Magnetometer resolution = 16 bits\n\r");
jaybehandsome	5:738285670edf	1206	if(Mmode == 2) bam.printf("Magnetometer ODR = 8 Hz\n\r");
jaybehandsome	5:738285670edf	1207	if(Mmode == 6) bam.printf("Magnetometer ODR = 100 Hz\n\r");
jaybehandsome	0:1e46c1a32764	1208	wait(1);
jaybehandsome	0:1e46c1a32764	1209	}
jaybehandsome	0:1e46c1a32764	1210	else
jaybehandsome	0:1e46c1a32764	1211	{
jaybehandsome	5:738285670edf	1212	bam.printf("Could not connect to MPU9250: \n\r");
jaybehandsome	5:738285670edf	1213	bam.printf("%#x \n", whoami);
jaybehandsome	0:1e46c1a32764	1214
jaybehandsome	0:1e46c1a32764	1215	sprintf(buffer, "WHO_AM_I 0x%x", whoami);
jaybehandsome	0:1e46c1a32764	1216
jaybehandsome	0:1e46c1a32764	1217
jaybehandsome	0:1e46c1a32764	1218	while(1) ; // Loop forever if communication doesn't happen
jaybehandsome	0:1e46c1a32764	1219	}
jaybehandsome	0:1e46c1a32764	1220
jaybehandsome	0:1e46c1a32764	1221	mpu9250.getAres(); // Get accelerometer sensitivity
jaybehandsome	0:1e46c1a32764	1222	mpu9250.getGres(); // Get gyro sensitivity
jaybehandsome	0:1e46c1a32764	1223	mpu9250.getMres(); // Get magnetometer sensitivity
jaybehandsome	6:1de63d5df56a	1224	pc.printf("Accelerometer sensitivity is %f LSB/g \n\r", 1.0f/aRes);
jaybehandsome	6:1de63d5df56a	1225	pc.printf("Gyroscope sensitivity is %f LSB/deg/s \n\r", 1.0f/gRes);
jaybehandsome	6:1de63d5df56a	1226	pc.printf("Magnetometer sensitivity is %f LSB/G \n\r", 1.0f/mRes);
jaybehandsome	0:1e46c1a32764	1227	magbias[0] = +470.; // User environmental x-axis correction in milliGauss, should be automatically calculated
jaybehandsome	0:1e46c1a32764	1228	magbias[1] = +120.; // User environmental x-axis correction in milliGauss
jaybehandsome	0:1e46c1a32764	1229	magbias[2] = +125.; // User environmental x-axis correction in milliGauss
jaybehandsome	0:1e46c1a32764	1230
jaybehandsome	0:1e46c1a32764	1231	while(1) {
jaybehandsome	0:1e46c1a32764	1232
jaybehandsome	5:738285670edf	1233
jaybehandsome	0:1e46c1a32764	1234	// If intPin goes high, all data registers have new data
jaybehandsome	0:1e46c1a32764	1235	if(mpu9250.readByte(MPU9250_ADDRESS, INT_STATUS) & 0x01) { // On interrupt, check if data ready interrupt
jaybehandsome	0:1e46c1a32764	1236
jaybehandsome	0:1e46c1a32764	1237	mpu9250.readGyroData(gyroCount); // Read the x/y/z adc values
jaybehandsome	0:1e46c1a32764	1238	// Calculate the gyro value into actual degrees per second
jaybehandsome	0:1e46c1a32764	1239	gx = (float)gyroCount[0]*gRes - gyroBias[0]; // get actual gyro value, this depends on scale being set
jaybehandsome	0:1e46c1a32764	1240	gy = (float)gyroCount[1]*gRes - gyroBias[1];
jaybehandsome	0:1e46c1a32764	1241	gz = (float)gyroCount[2]*gRes - gyroBias[2];
jaybehandsome	0:1e46c1a32764	1242
jaybehandsome	0:1e46c1a32764	1243	mpu9250.MahonyQuaternionUpdate(ax, ay, az, gxPI/180.0f, gyPI/180.0f, gz*PI/180.0f, my, mx, mz);
jaybehandsome	0:1e46c1a32764	1244
jaybehandsome	0:1e46c1a32764	1245	// Serial print and/or display at 0.5 s rate independent of data rates
jaybehandsome	4:9cc307f25dc9	1246	delt_t = t.read_us() - count;
jaybehandsome	4:9cc307f25dc9	1247	if (delt_t > 1) { // update LCD once per half-second independent of read rate
jaybehandsome	6:1de63d5df56a	1248
jaybehandsome	7:61c1f10bf484	1249	x = 1;
jaybehandsome	4:9cc307f25dc9	1250	posA += (gzdelt_tx/1000000);
jaybehandsome	4:9cc307f25dc9	1251	posA = fmod(posA,360);
jaybehandsome	4:9cc307f25dc9	1252	posB = fmod(posA + 240,360);
jaybehandsome	4:9cc307f25dc9	1253	posC = fmod(posA + 120,360);
jaybehandsome	6:1de63d5df56a	1254	count = t.read_us();
jaybehandsome	6:1de63d5df56a	1255
jaybehandsome	5:738285670edf	1256	if (mode == 1)
jaybehandsome	5:738285670edf	1257	{
jaybehandsome	7:61c1f10bf484	1258
jaybehandsome	6:1de63d5df56a	1259	Velocity(v,posA,posB,posC);
jaybehandsome	5:738285670edf	1260	}
jaybehandsome	6:1de63d5df56a	1261	else if (mode == 2)
jaybehandsome	6:1de63d5df56a	1262	{
jaybehandsome	6:1de63d5df56a	1263	Text((char)word[0],posA,posB,posC,5);
jaybehandsome	6:1de63d5df56a	1264	Text((char)word[1],posA,posB,posC,4);
jaybehandsome	6:1de63d5df56a	1265	Text((char)word[2],posA,posB,posC,3);
jaybehandsome	6:1de63d5df56a	1266	Text((char)word[3],posA,posB,posC,2);
jaybehandsome	6:1de63d5df56a	1267	Text((char)word[4],posA,posB,posC,1);
jaybehandsome	6:1de63d5df56a	1268	Text((char)word[5],posA,posB,posC,0);
jaybehandsome	3:46cc9d386ff4	1269	}
jaybehandsome	4:9cc307f25dc9	1270
jaybehandsome	0:1e46c1a32764	1271	}
jaybehandsome	5:738285670edf	1272	delt_t2 = t.read_us() - count2;
jaybehandsome	5:738285670edf	1273	if (delt_t2 >= 1000000)
jaybehandsome	5:738285670edf	1274	{
jaybehandsome	7:61c1f10bf484	1275	v =(gzxPI0.353600)/(180*1000);
jaybehandsome	5:738285670edf	1276	pc.printf("%0.1f",v);
jaybehandsome	5:738285670edf	1277	count2 = t.read_us();
jaybehandsome	5:738285670edf	1278	}
jaybehandsome	6:1de63d5df56a	1279
jaybehandsome	5:738285670edf	1280	if (pc.readable())
jaybehandsome	6:1de63d5df56a	1281
jaybehandsome	5:738285670edf	1282	{
jaybehandsome	5:738285670edf	1283	cmode = pc.getc();
jaybehandsome	6:1de63d5df56a	1284	switch(cmode)
jaybehandsome	5:738285670edf	1285	{
jaybehandsome	6:1de63d5df56a	1286	case '&':
jaybehandsome	6:1de63d5df56a	1287	word.clear();
jaybehandsome	6:1de63d5df56a	1288	break;
jaybehandsome	6:1de63d5df56a	1289
jaybehandsome	5:738285670edf	1290	case '?':
jaybehandsome	5:738285670edf	1291	mode = 1;
jaybehandsome	5:738285670edf	1292	break;
jaybehandsome	5:738285670edf	1293
jaybehandsome	6:1de63d5df56a	1294	case '!':
jaybehandsome	5:738285670edf	1295	mode = 2;
jaybehandsome	5:738285670edf	1296	break;
jaybehandsome	6:1de63d5df56a	1297
jaybehandsome	6:1de63d5df56a	1298	default:
jaybehandsome	6:1de63d5df56a	1299	word += cmode;
jaybehandsome	5:738285670edf	1300	}
jaybehandsome	6:1de63d5df56a	1301	// bam.printf("%c %s %d\n",cmode, word, word.length());
jaybehandsome	5:738285670edf	1302	}
jaybehandsome	0:1e46c1a32764	1303	}
jaybehandsome	3:46cc9d386ff4	1304
jaybehandsome	4:9cc307f25dc9	1305
jaybehandsome	4:9cc307f25dc9	1306	}
jaybehandsome	0:1e46c1a32764	1307	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	10 Dec 2017
Imports:	7
Forks:	0
Commits:	8
Dependents:	0
Dependencies:	1
Followers:	5

main.cpp@7:61c1f10bf484, 2017-12-12 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning