Dmitry Kovalev / Mbed 2 deprecated LG2

fork

Dependencies:   mbed

Fork of LG by igor Apu

pin.c@211:ac8251b067d2, 2017-07-03 (annotated)

Committer:
Kovalev_D
Date:
Mon Jul 03 05:50:08 2017 +0000
Revision:
211:ac8251b067d2
Parent:
209:224e7331a061
Child:
213:9953db9543d6
prizm worck

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Kovalev_D 28:1c9acd3b224d 1 #include "Global.h"
Kovalev_D 208:19150d2b528f 2 int Try=0,TimeDischarg=0;
Kovalev_D 208:19150d2b528f 3 int Light=0;
Kovalev_D 28:1c9acd3b224d 4 void PinCheng(void)
Kovalev_D 28:1c9acd3b224d 5 {
Kovalev_D 40:8a6494f61326 6 //================ блок управления ногой поджига======================
Kovalev_D 40:8a6494f61326 7 if((Gyro.PinReg & PinRegBitD) != (Gyro.PinRegOld & PinRegBitD)) {//если текушее состояние бита поджига в регистре ног отличается от предыдущего то:
Kovalev_D 40:8a6494f61326 8 if(Gyro.PinReg & PinRegBitD) LightUpON else LightUpOFF//если бита поджига еденица то включить поджиг если 0 отключить
Kovalev_D 40:8a6494f61326 9 }
igor_v 42:6fc307c4963e 10
Kovalev_D 40:8a6494f61326 11 //============= блок управления подсветкой======================
Kovalev_D 40:8a6494f61326 12 if((Gyro.PinReg & PinRegBitL) != (Gyro.PinRegOld & PinRegBitL)) {
Kovalev_D 40:8a6494f61326 13 if(Gyro.PinReg & PinRegBitL) BackLightON else BackLightOFF
Kovalev_D 40:8a6494f61326 14 }
Kovalev_D 203:3a6615de9581 15 /*
Kovalev_D 40:8a6494f61326 16 //============= блок управления вибро нога 1======================
Kovalev_D 40:8a6494f61326 17 if((Gyro.PinReg & PinRegBit_1V) != (Gyro.PinRegOld & PinRegBit_1V)) {
Kovalev_D 47:d902ef6f7564 18 if(Gyro.PinReg & PinRegBit_1V) ClrV1 else SetV1
Kovalev_D 40:8a6494f61326 19 }
igor_v 42:6fc307c4963e 20
Kovalev_D 40:8a6494f61326 21 //============= блок управления вибро нога 2======================
Kovalev_D 40:8a6494f61326 22 if((Gyro.PinReg & PinRegBit_2V) != (Gyro.PinRegOld & PinRegBit_2V)) {
Kovalev_D 47:d902ef6f7564 23 if(Gyro.PinReg & PinRegBit_2V) ClrV2 else SetV2
Kovalev_D 40:8a6494f61326 24 }
Kovalev_D 188:4c523cc373cc 25 */
Kovalev_D 47:d902ef6f7564 26
Kovalev_D 47:d902ef6f7564 27 if((Gyro.PinReg & PinRegBitTXE) != (Gyro.PinRegOld & PinRegBitTXE)) {
Kovalev_D 47:d902ef6f7564 28 if(Gyro.PinReg & PinRegBitTXE) TXOn else TXOff
Kovalev_D 47:d902ef6f7564 29 }
Kovalev_D 190:289514f730ee 30 Gyro.PinRegOld = Gyro.PinReg; //сохранение текущего регистра как старого для следующего такта сравнения.
Kovalev_D 190:289514f730ee 31 }
Kovalev_D 190:289514f730ee 32
Kovalev_D 28:1c9acd3b224d 33
Kovalev_D 190:289514f730ee 34 void Discharg ()//проверка битового поля поджига и установка значения бита поджига
Kovalev_D 208:19150d2b528f 35 {
Kovalev_D 208:19150d2b528f 36 /* sprintf((Time),"%d %d\r\n",Gyro.RgConA, Gyro.RgConB);
Kovalev_D 208:19150d2b528f 37 WriteCon(Time); */
Kovalev_D 208:19150d2b528f 38
Kovalev_D 190:289514f730ee 39 if (Gyro.Discharg)
Kovalev_D 208:19150d2b528f 40 {
Kovalev_D 211:ac8251b067d2 41 if(Gyro.LG_Type==1) Spi.DAC_A = (unsigned int)(32767-(GyroP.Str.DAC_current_Work>>1));
Kovalev_D 211:ac8251b067d2 42 else Spi.DAC_A =(((int)(GyroP.Str.DAC_current_Start*0.98+0x7fff) & 0xffff));
Kovalev_D 211:ac8251b067d2 43
Kovalev_D 208:19150d2b528f 44 Gyro.Discharg = Gyro.Discharg >> 1;
Kovalev_D 209:224e7331a061 45 if(!Gyro.LaserOn)
Kovalev_D 209:224e7331a061 46 {
Kovalev_D 208:19150d2b528f 47 Gyro.RgConA = 0x0000;
Kovalev_D 208:19150d2b528f 48 Gyro.RgConB = 0x0000;
Kovalev_D 209:224e7331a061 49 }
Kovalev_D 190:289514f730ee 50 //Проверка здвигового поля(последовательности) поджига
Kovalev_D 190:289514f730ee 51 //если последний бит 1 то установить бит поджига в еденицу, иначе в 0;
Kovalev_D 208:19150d2b528f 52 if (Gyro.Discharg & 0x1) Gyro.PinReg |= PinRegBitD;
Kovalev_D 208:19150d2b528f 53 else Gyro.PinReg &= ~PinRegBitD;
Kovalev_D 190:289514f730ee 54 }
Kovalev_D 208:19150d2b528f 55 else if(TimeDischarg<3)
Kovalev_D 208:19150d2b528f 56 {
Kovalev_D 208:19150d2b528f 57 TimeDischarg++;
Kovalev_D 208:19150d2b528f 58 if(TimeDischarg==1)
Kovalev_D 208:19150d2b528f 59 {
Kovalev_D 211:ac8251b067d2 60 if (Spi.ADC5>35000)
Kovalev_D 208:19150d2b528f 61 {
Kovalev_D 208:19150d2b528f 62 if (Try<10)
Kovalev_D 208:19150d2b528f 63 {
Kovalev_D 208:19150d2b528f 64 Gyro.Discharg = StartDischarg << ShiftStart0;
Kovalev_D 208:19150d2b528f 65 Gyro.BackLight = StartBackLight << ShiftStart0;
Kovalev_D 208:19150d2b528f 66 TimeDischarg=0;
Kovalev_D 208:19150d2b528f 67 Try++;
Kovalev_D 208:19150d2b528f 68 }
Kovalev_D 208:19150d2b528f 69 }
Kovalev_D 209:224e7331a061 70
Kovalev_D 209:224e7331a061 71
Kovalev_D 209:224e7331a061 72
Kovalev_D 208:19150d2b528f 73 else
Kovalev_D 208:19150d2b528f 74 {
Kovalev_D 209:224e7331a061 75 //
Kovalev_D 209:224e7331a061 76 if(!Gyro.LaserOn)
Kovalev_D 209:224e7331a061 77 {
Kovalev_D 208:19150d2b528f 78 Gyro.LaserOn=1;
Kovalev_D 211:ac8251b067d2 79 if(Gyro.LG_Type==1) Gyro.RgConA = 0xff;
Kovalev_D 211:ac8251b067d2 80 else Gyro.RgConA = 0xfd;
Kovalev_D 209:224e7331a061 81 Gyro.RgConB = 0x4;
Kovalev_D 209:224e7331a061 82 }
Kovalev_D 208:19150d2b528f 83 TimeDischarg=5;
Kovalev_D 208:19150d2b528f 84 Try=0;
Kovalev_D 211:ac8251b067d2 85 if(Gyro.LG_Type==1) Spi.DAC_A = (unsigned int)(32767-(GyroP.Str.DAC_current_Work>>1));
Kovalev_D 211:ac8251b067d2 86 else Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+0x7fff) & 0xffff)+22544)*0.65);
Kovalev_D 208:19150d2b528f 87 }
Kovalev_D 208:19150d2b528f 88 }
Kovalev_D 208:19150d2b528f 89 }
Kovalev_D 190:289514f730ee 90 }
Kovalev_D 190:289514f730ee 91 void BackLight ()
Kovalev_D 190:289514f730ee 92 {
Kovalev_D 190:289514f730ee 93 if (Gyro.BackLight)
Kovalev_D 208:19150d2b528f 94 { Gyro.BackLight = Gyro.BackLight >> 1;
Kovalev_D 190:289514f730ee 95 //Проверка здвигового поля(последовательности) подсветки
Kovalev_D 190:289514f730ee 96 //если последний бит в битовом поле 1 то установить бит подсветки в еденицу, иначе в 0;
Kovalev_D 208:19150d2b528f 97 if (Gyro.BackLight & 0x1) Gyro.PinReg |= PinRegBitL; else Gyro.PinReg &= ~PinRegBitL;
Kovalev_D 208:19150d2b528f 98 }
Kovalev_D 28:1c9acd3b224d 99 }