forkd

Dependencies:   mbed

Fork of LG2 by Dmitry Kovalev

Committer:
Kovalev_D
Date:
Fri Jan 05 08:14:38 2018 +0000
Revision:
227:2774b56bfab0
Parent:
226:4a4d5bd5fcd7
05.01.2018

Who changed what in which revision?

UserRevisionLine numberNew contents of line
igor_v 0:8ad47e2b6f00 1 #include "Global.h"
igor_v 0:8ad47e2b6f00 2
Kovalev_D 89:a0d344db227e 3 unsigned int VibroReg = 0; //регистр состаяния вибропривода.
Kovalev_D 89:a0d344db227e 4 unsigned long Global_Time, Time_UART,Time_Sec,Time_vibro,Time_1kHz;
Kovalev_D 197:7a05523bf588 5 float t1;
Kovalev_D 89:a0d344db227e 6 unsigned char BuffTemp[100];
Kovalev_D 197:7a05523bf588 7 unsigned char Time[1000];
Kovalev_D 86:398da56ef751 8 unsigned int Event1Hz;
Kovalev_D 208:19150d2b528f 9 unsigned int Event100Hz;
Kovalev_D 209:224e7331a061 10 unsigned int Event250Hz;
Kovalev_D 124:9ae09249f842 11 unsigned int Event500Hz;
Kovalev_D 203:3a6615de9581 12 unsigned int Event1K;
Kovalev_D 214:4c70e452c491 13 unsigned int Event1250Hz;
Kovalev_D 222:7de7b3bf3a1d 14 unsigned int Event5K;
Kovalev_D 88:b5c1d9d338d1 15 unsigned int Event100K;
Kovalev_D 88:b5c1d9d338d1 16 unsigned int EventVibro;
Kovalev_D 211:ac8251b067d2 17 unsigned int MODFlag=0;
Kovalev_D 197:7a05523bf588 18 unsigned int Time250Hz;
Kovalev_D 197:7a05523bf588 19 unsigned int Event250Hz;
Kovalev_D 197:7a05523bf588 20
Kovalev_D 124:9ae09249f842 21 unsigned int Time100K;
Kovalev_D 88:b5c1d9d338d1 22 unsigned int Time1K;
Kovalev_D 214:4c70e452c491 23 unsigned int Time1250Hz;
Kovalev_D 222:7de7b3bf3a1d 24 unsigned int Time5K;
Kovalev_D 124:9ae09249f842 25 unsigned int Time500Hz;
Kovalev_D 209:224e7331a061 26 unsigned int Time250Hz;
Kovalev_D 88:b5c1d9d338d1 27 unsigned int Time1Hz;
Kovalev_D 208:19150d2b528f 28 unsigned int Time100Hz;
Kovalev_D 88:b5c1d9d338d1 29 unsigned int Clock1Hz;
Kovalev_D 86:398da56ef751 30 unsigned int ShiftD;
Kovalev_D 86:398da56ef751 31 unsigned int ShiftL;
Kovalev_D 215:b58b887fd367 32
Kovalev_D 215:b58b887fd367 33
Kovalev_D 215:b58b887fd367 34
Kovalev_D 215:b58b887fd367 35
Kovalev_D 215:b58b887fd367 36
Kovalev_D 216:189b0ea1dc38 37 int BuffADC_1Point [600];
Kovalev_D 216:189b0ea1dc38 38 int BuffADC_1Point_64 [100];
Kovalev_D 216:189b0ea1dc38 39 int BuffADC_1Point_Recalc [100];
Kovalev_D 220:04c54405b82d 40
Kovalev_D 220:04c54405b82d 41 int BuffADC_128Point [100];
Kovalev_D 220:04c54405b82d 42 int BuffADC_64Point [100];
Kovalev_D 227:2774b56bfab0 43
Kovalev_D 227:2774b56bfab0 44 int BuffPLC_FILT [20];
Kovalev_D 227:2774b56bfab0 45 unsigned int C_PLC_F=0;
Kovalev_D 227:2774b56bfab0 46
Kovalev_D 220:04c54405b82d 47 int BuffADC_32Point [100];
Kovalev_D 216:189b0ea1dc38 48 int BuffADC_16Point [100];
Kovalev_D 226:4a4d5bd5fcd7 49
Kovalev_D 226:4a4d5bd5fcd7 50 int BuffADC_10HFO [100];
Kovalev_D 220:04c54405b82d 51 int BuffADC_10v [100];
Kovalev_D 226:4a4d5bd5fcd7 52
Kovalev_D 220:04c54405b82d 53 int BuffADC_10v_OLD [100];
Kovalev_D 220:04c54405b82d 54 int BuffADC_10v_F [100];
Kovalev_D 220:04c54405b82d 55 int BuffADC_znak [100];
Kovalev_D 215:b58b887fd367 56
Kovalev_D 215:b58b887fd367 57 int Buff_Restored_Mod [100];
Kovalev_D 215:b58b887fd367 58 int Buff_PLC_Eror [100];
Kovalev_D 215:b58b887fd367 59 int BSinMns [100];
Kovalev_D 215:b58b887fd367 60 int BSinPls [100];
Kovalev_D 215:b58b887fd367 61 int ADC_1Point =0;
Kovalev_D 215:b58b887fd367 62 int ADC_32PointD =0;
Kovalev_D 220:04c54405b82d 63
Kovalev_D 220:04c54405b82d 64 int ADC_128Point =0;
Kovalev_D 215:b58b887fd367 65 int ADC_64Point =0;
Kovalev_D 220:04c54405b82d 66 int ADC_32Point =0;
Kovalev_D 215:b58b887fd367 67 int ADC_16Point =0;
Kovalev_D 205:775d54fdf646 68 //unsigned int EventMod;
Kovalev_D 140:1fbf117fc120 69
Kovalev_D 139:1716152517aa 70
Kovalev_D 134:caf4c9cd5052 71 __asm void boot_jump( uint32_t address ){
Kovalev_D 134:caf4c9cd5052 72 LDR SP, [R0] ;Load new stack pointer address
Kovalev_D 134:caf4c9cd5052 73 LDR R0, [R0, #4] ;Load new program counter address
Kovalev_D 134:caf4c9cd5052 74 BX R0
Kovalev_D 134:caf4c9cd5052 75 }
Kovalev_D 134:caf4c9cd5052 76
Kovalev_D 205:775d54fdf646 77 void Param_init(void)
Kovalev_D 205:775d54fdf646 78 {
Kovalev_D 208:19150d2b528f 79 int temp=0;
Kovalev_D 208:19150d2b528f 80
Kovalev_D 205:775d54fdf646 81 InitMOD();
Kovalev_D 227:2774b56bfab0 82 for(int q=0; q<20; q++)
Kovalev_D 227:2774b56bfab0 83 {
Kovalev_D 227:2774b56bfab0 84 BuffPLC_FILT [q] = 0;
Kovalev_D 227:2774b56bfab0 85 }
Kovalev_D 211:ac8251b067d2 86 Gyro.CuruAngleLog=0;
Kovalev_D 205:775d54fdf646 87 Global_Time = 0;
Kovalev_D 88:b5c1d9d338d1 88 Time_UART = 0;
Kovalev_D 88:b5c1d9d338d1 89 Time_Sec = 0;
Kovalev_D 88:b5c1d9d338d1 90 Time_vibro = 0;
Kovalev_D 214:4c70e452c491 91 Time1250Hz = 0;
Kovalev_D 88:b5c1d9d338d1 92 Time_1kHz = 0;
Kovalev_D 88:b5c1d9d338d1 93 Event1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 94 Event1K = 0;
Kovalev_D 88:b5c1d9d338d1 95 Event100K = 0;
Kovalev_D 88:b5c1d9d338d1 96 EventVibro = 0;
Kovalev_D 88:b5c1d9d338d1 97 Time1K = 0;
Kovalev_D 88:b5c1d9d338d1 98 Time100K = 0;
Kovalev_D 88:b5c1d9d338d1 99 Time1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 100 Clock1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 101 ShiftD = 0;
Kovalev_D 88:b5c1d9d338d1 102 ShiftL = 0;
Kovalev_D 124:9ae09249f842 103 Event500Hz = 0;
Kovalev_D 124:9ae09249f842 104 Time500Hz = 0;
Kovalev_D 215:b58b887fd367 105
Kovalev_D 205:775d54fdf646 106 Temp_AMP64P = 0;
Kovalev_D 215:b58b887fd367 107
Kovalev_D 205:775d54fdf646 108 Gyro.Log = 0;
Kovalev_D 205:775d54fdf646 109 Gyro.LogPLC = 0;
Kovalev_D 205:775d54fdf646 110 Gyro.PLC_Lern = 0;
Kovalev_D 106:250ddd8629c6 111 Gyro.CuruAngle = 0;
Kovalev_D 88:b5c1d9d338d1 112 Pulse_8Point = 0;
Kovalev_D 88:b5c1d9d338d1 113 Pulse_16Point = 0;
Kovalev_D 88:b5c1d9d338d1 114 Pulse_16PointD = 0;
Kovalev_D 88:b5c1d9d338d1 115 Pulse_32Point = 0;
Kovalev_D 209:224e7331a061 116 Gyro.FlashMod = 0;
Kovalev_D 208:19150d2b528f 117
Kovalev_D 205:775d54fdf646 118
Kovalev_D 205:775d54fdf646 119 /////////////////////////////////////////////
Kovalev_D 205:775d54fdf646 120 ///////////инициализация таймеров////////////
Kovalev_D 205:775d54fdf646 121 /////////////////////////////////////////////
Kovalev_D 205:775d54fdf646 122 Init_TIM1(TIME_INTERVAL ); //Timer 1: CCLK / 7812 = 12800.819Hz; Vibro: Timer1/32 = 400.025Hz; 10ms???
Kovalev_D 205:775d54fdf646 123 Init_TIM2(); //Timer 2: CCLK / 4 / 250 = 100kHz
Kovalev_D 205:775d54fdf646 124 /////////////////////////////////////////////
Kovalev_D 205:775d54fdf646 125 /////////////инициализация переменных в структ вибро/////////////////
Kovalev_D 206:00341a03e05c 126
Kovalev_D 206:00341a03e05c 127 Gyro.DropDelayGLD = DropDelayGLD_0;//задержка на выдачу 45 микросекунд для любого адреса ГЛД
Kovalev_D 206:00341a03e05c 128 Gyro.PLC_Error2Mode = 1400;
Kovalev_D 206:00341a03e05c 129 Gyro.SOC_Out = 0xDD;
Kovalev_D 209:224e7331a061 130
Kovalev_D 209:224e7331a061 131 Gyro.RgConMod = 1;
Kovalev_D 206:00341a03e05c 132
Kovalev_D 206:00341a03e05c 133 GyroP.Str.ParamMod=0;
Kovalev_D 209:224e7331a061 134
Kovalev_D 209:224e7331a061 135 ReadFlash ();
Kovalev_D 210:b02fa166315d 136 // GyroP.Str.ParamMod=0;
Kovalev_D 225:f8fee6c586cc 137 if(GyroP.Str.ParamMod==1)
Kovalev_D 211:ac8251b067d2 138 {
Kovalev_D 220:04c54405b82d 139 Gyro.ShowMod2=0;
Kovalev_D 222:7de7b3bf3a1d 140 Gyro.TimeToJump = GyroP.Str.TimeToJump;
Kovalev_D 222:7de7b3bf3a1d 141 Gyro.JumpDelta = GyroP.Str.JumpDelta;
Kovalev_D 220:04c54405b82d 142 Gyro.ShiftMod = GyroP.Str.ShiftMod;
Kovalev_D 211:ac8251b067d2 143 Gyro.PLC_Start = 0x7fff+GyroP.Str.PLC_Start;
Kovalev_D 225:f8fee6c586cc 144 Gyro.DownTreshold = (unsigned int)((GyroP.Str.DownTreshold-0x7fff)&0xffff); //27
Kovalev_D 225:f8fee6c586cc 145 Gyro.HighTreshold = (unsigned int)((GyroP.Str.HighTreshold-0x7fff)&0xffff);
Kovalev_D 225:f8fee6c586cc 146 Gyro.PLCDelay = GyroP.Str.PLCDelay;
Kovalev_D 225:f8fee6c586cc 147 Gyro.ResetLevelCool = (unsigned int)((GyroP.Str.ResetLevelCool-0x7fff)&0xffff); //105
Kovalev_D 225:f8fee6c586cc 148 Gyro.ResetLevelHeat = (unsigned int)((GyroP.Str.ResetLevelHeat-0x7fff)&0xffff);
Kovalev_D 211:ac8251b067d2 149 Gyro.HFO_Gain = GyroP.Str.HFO_Gain;
Kovalev_D 226:4a4d5bd5fcd7 150 Gyro.HFO_ref = (unsigned int)(GyroP.Str.HFO_ref);
Kovalev_D 211:ac8251b067d2 151 Gyro.LG_Type = GyroP.Str.LG_Type;
Kovalev_D 226:4a4d5bd5fcd7 152 Gyro.LG_Type = 1;
Kovalev_D 208:19150d2b528f 153 Gyro.My_Addres = GyroP.Str.My_Addres; // Gyro.My_Addres = 0;
Kovalev_D 209:224e7331a061 154 Gyro.GLD_Serial = GyroP.Str.GLD_Serial;
Kovalev_D 209:224e7331a061 155 Gyro.FrqHZ = (7680000/GyroP.Str.FrqHZ);
Kovalev_D 209:224e7331a061 156 Gyro.Frq = ((7680000/GyroP.Str.FrqHZ)<<16);
Kovalev_D 209:224e7331a061 157 Gyro.FrqHZmin = ((7680000/GyroP.Str.FrqHZmin)<<16);
Kovalev_D 209:224e7331a061 158 Gyro.FrqHZmax = ((7680000/GyroP.Str.FrqHZmax)<<16);
Kovalev_D 208:19150d2b528f 159 Gyro.FrqChengSpeed = GyroP.Str.FrqChengSpeed;
Kovalev_D 208:19150d2b528f 160 Gyro.PLC_Gain = GyroP.Str.PLC_Gain;
Kovalev_D 208:19150d2b528f 161 Gyro.PLC_Phase = GyroP.Str.PLC_Phase;
Kovalev_D 208:19150d2b528f 162 Gyro.ModAmp = GyroP.Str.ModAmp;
Kovalev_D 208:19150d2b528f 163 Gyro.FrqPhase = GyroP.Str.FrqPhase;
Kovalev_D 214:4c70e452c491 164 Gyro.AmpPer = 700;//GyroP.Str.AmpPer*100;
Kovalev_D 214:4c70e452c491 165 Gyro.Amp =(GyroP.Str.AmpPer<<17);
Kovalev_D 208:19150d2b528f 166 Gyro.AmpSpeed = GyroP.Str.AmpSpeed;
Kovalev_D 208:19150d2b528f 167 Gyro.AmpPerDel = GyroP.Str.AmpPerDel;
Kovalev_D 208:19150d2b528f 168 temp=((GyroP.Str.VB_Fdf_Hi<<16) | GyroP.Str.VB_Fdf_Lo);
Kovalev_D 210:b02fa166315d 169 temp=temp*20;
Kovalev_D 208:19150d2b528f 170 Gyro.AmpTarget=(unsigned int)(temp);
Kovalev_D 208:19150d2b528f 171 Gyro.AmpPerMin = GyroP.Str.AmpPerMin;
Kovalev_D 208:19150d2b528f 172 Gyro.AmpPerMax = GyroP.Str.AmpPerMax;
Kovalev_D 208:19150d2b528f 173 Gyro.AmpMin = GyroP.Str.AmpMin;
Kovalev_D 208:19150d2b528f 174 Gyro.AmpTD = GyroP.Str.AmpTD;
Kovalev_D 214:4c70e452c491 175 F_vib=(103200000<<5)/((Gyro.Frq)>>10);//периуд вибро.
Kovalev_D 214:4c70e452c491 176 T_vibP = F_vib/10000;
Kovalev_D 214:4c70e452c491 177 T_vib_1 = Gyro.AmpPer * T_vibP;
Kovalev_D 214:4c70e452c491 178 T_vib_2 = T_vibP * (10000-Gyro.AmpPer);
Kovalev_D 214:4c70e452c491 179 LPC_MCPWM->LIM1 = F_vib;
Kovalev_D 214:4c70e452c491 180 LPC_MCPWM->LIM2 = F_vib;
Kovalev_D 214:4c70e452c491 181 LPC_MCPWM->MAT1 = T_vib_1;
Kovalev_D 214:4c70e452c491 182 LPC_MCPWM->MAT2 = T_vib_2;
Kovalev_D 211:ac8251b067d2 183 if(Gyro.LG_Type==1){
Kovalev_D 225:f8fee6c586cc 184 //Gyro.HFO_Max=((int)(GyroP.Str.DAC_current_Work*0.67)-2000);
Kovalev_D 225:f8fee6c586cc 185 Gyro.HFO_Max=0xffff-GyroP.Str.DAC_current_Work;
Kovalev_D 225:f8fee6c586cc 186
Kovalev_D 225:f8fee6c586cc 187 //Gyro.HFO_Min=((int)(GyroP.Str.DAC_current_Start*0.67)-2000);
Kovalev_D 225:f8fee6c586cc 188 Gyro.HFO_Min= 0xffff-GyroP.Str.DAC_current_Start;
Kovalev_D 211:ac8251b067d2 189 }
Kovalev_D 211:ac8251b067d2 190 else Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+0x7fff) & 0xffff)+22544)*0.65);
Kovalev_D 209:224e7331a061 191 Gyro.DacIn = GyroP.Str.DAC_current_Work;
Kovalev_D 208:19150d2b528f 192 // Gyro.TermoNKU = GyroP.Str.TermoNKU<<2;
Kovalev_D 209:224e7331a061 193 Gyro.Firmware_Version = 0x11;
Kovalev_D 208:19150d2b528f 194 // Spi.DAC_A = GyroP.Str.DAC_A;
Kovalev_D 209:224e7331a061 195 // Spi.DAC_B = GyroP.Str.DAC_B;
Kovalev_D 208:19150d2b528f 196 Gyro.Gain_Sin = GyroP.Str.Gain_Sin;
Kovalev_D 208:19150d2b528f 197 Gyro.Gain_Cos = GyroP.Str.Gain_Cos;
Kovalev_D 208:19150d2b528f 198 Out_G_photo(Gyro.Gain_Sin, Gyro.Gain_Cos);
Kovalev_D 206:00341a03e05c 199 }
Kovalev_D 206:00341a03e05c 200 else
Kovalev_D 206:00341a03e05c 201 {
Kovalev_D 211:ac8251b067d2 202 Gyro.DownTreshold = GyroP.Str.DownTreshold; //27
Kovalev_D 211:ac8251b067d2 203 Gyro.HighTreshold = GyroP.Str.HighTreshold;
Kovalev_D 225:f8fee6c586cc 204 Gyro.PLCDelay = 5000;
Kovalev_D 211:ac8251b067d2 205 Gyro.ResetLevelCool = 56000; //105
Kovalev_D 211:ac8251b067d2 206 Gyro.ResetLevelHeat = 15000;
Kovalev_D 211:ac8251b067d2 207 Gyro.HFO_ref = 13000;
Kovalev_D 211:ac8251b067d2 208 Gyro.LG_Type = 0;
Kovalev_D 208:19150d2b528f 209 Gyro.PLC_Phase = 3;
Kovalev_D 208:19150d2b528f 210 Gyro.PLC_Gain = 3;
Kovalev_D 208:19150d2b528f 211 Gyro.FrqPhase = 8;
Kovalev_D 207:d1ce992f5d17 212 Gyro.FrqHZ = 403;
Kovalev_D 206:00341a03e05c 213 Gyro.Frq = Gyro.FrqHZ<<16;
Kovalev_D 206:00341a03e05c 214 Gyro.FrqHZmin = 350<<16;
Kovalev_D 206:00341a03e05c 215 Gyro.FrqHZmax = 450<<16;
Kovalev_D 206:00341a03e05c 216 Gyro.FrqChengSpeed = 100;
Kovalev_D 206:00341a03e05c 217 Gyro.ModAmp = 250;
Kovalev_D 208:19150d2b528f 218 Gyro.AmpPer = 20;
Kovalev_D 207:d1ce992f5d17 219 Gyro.AmpPerMin = 2;
Kovalev_D 206:00341a03e05c 220 Gyro.AmpPerMax = 90;
Kovalev_D 206:00341a03e05c 221 Gyro.AmpSpeed = 1;
Kovalev_D 207:d1ce992f5d17 222 Gyro.AmpPerDel = 3;
Kovalev_D 208:19150d2b528f 223 Gyro.AmpTarget = 5500;// целевая амплитуда ВП
Kovalev_D 208:19150d2b528f 224 Gyro.Amp = 20*65535;
Kovalev_D 207:d1ce992f5d17 225 Gyro.AmpMin = 20;// минимальное значение AmpT;5
Kovalev_D 208:19150d2b528f 226 Gyro.AmpTD = 20;////////////////////////////////////////////////////////
Kovalev_D 206:00341a03e05c 227 Gyro.TermoNKU = 44700;//48824*0,0061-273=25 С°
Kovalev_D 211:ac8251b067d2 228 Spi.DAC_B = Gyro.PLC_Start;
Kovalev_D 206:00341a03e05c 229 Gyro.PLC_Error2Mode = 1400; //для записи мод
Kovalev_D 207:d1ce992f5d17 230 Gyro.Gain_Sin = 175;
Kovalev_D 207:d1ce992f5d17 231 Gyro.Gain_Cos = 215;
Kovalev_D 209:224e7331a061 232 Gyro.Firmware_Version = 0x11; //версия программы
Kovalev_D 205:775d54fdf646 233 Gyro.GLD_Serial = 123; //серийный номер
Kovalev_D 182:ebcd2bc3be8f 234 Gyro.My_Addres = 0; //адрес глд
Kovalev_D 208:19150d2b528f 235 Gyro.Tmp_OffsetT4 = 0;
Kovalev_D 208:19150d2b528f 236 Gyro.Tmp_OffsetT5 = 0;
Kovalev_D 208:19150d2b528f 237 Gyro.Tmp_scaleT4 = 1; //53
Kovalev_D 208:19150d2b528f 238 Gyro.Tmp_scaleT5 = 1;
Kovalev_D 208:19150d2b528f 239
Kovalev_D 208:19150d2b528f 240 Gyro.DAC_current_Work =50000; //3
Kovalev_D 208:19150d2b528f 241 Gyro.DAC_current_Start =41000;
Kovalev_D 211:ac8251b067d2 242
Kovalev_D 214:4c70e452c491 243
Kovalev_D 214:4c70e452c491 244 F_vib=(103200000<<5)/((Gyro.Frq)>>10);//периуд вибро.
Kovalev_D 214:4c70e452c491 245 T_vibP = F_vib/10000;
Kovalev_D 214:4c70e452c491 246 T_vib_1 = Gyro.AmpPer * T_vibP;
Kovalev_D 214:4c70e452c491 247 T_vib_2 = T_vibP * (10000-Gyro.AmpPer);
Kovalev_D 214:4c70e452c491 248 LPC_MCPWM->LIM1 = F_vib;
Kovalev_D 214:4c70e452c491 249 LPC_MCPWM->LIM2 = F_vib;
Kovalev_D 214:4c70e452c491 250 LPC_MCPWM->MAT1 = T_vib_1;
Kovalev_D 214:4c70e452c491 251 LPC_MCPWM->MAT2 = T_vib_2;
Kovalev_D 206:00341a03e05c 252 }
Kovalev_D 211:ac8251b067d2 253 Spi.DAC_B=Gyro.PLC_Start;
Kovalev_D 188:4c523cc373cc 254 switch(Gyro.My_Addres){//смещение поджига и подсветки в зависимости от адреса ГЛД
Kovalev_D 188:4c523cc373cc 255 case 0:
Kovalev_D 209:224e7331a061 256 Gyro.Discharg = StartDischarg << ShiftStart0;
Kovalev_D 188:4c523cc373cc 257 Gyro.BackLight = StartBackLight << ShiftStart0;
Kovalev_D 188:4c523cc373cc 258 break;
Kovalev_D 188:4c523cc373cc 259 case 1:
Kovalev_D 209:224e7331a061 260 Gyro.Discharg = StartDischarg << ShiftStart1;
Kovalev_D 188:4c523cc373cc 261 Gyro.BackLight = StartBackLight << ShiftStart1;
Kovalev_D 188:4c523cc373cc 262 break;
Kovalev_D 188:4c523cc373cc 263 case 2:
Kovalev_D 209:224e7331a061 264 Gyro.Discharg = StartDischarg << ShiftStart2;
Kovalev_D 188:4c523cc373cc 265 Gyro.BackLight = StartBackLight << ShiftStart2;
Kovalev_D 188:4c523cc373cc 266 break;
Kovalev_D 188:4c523cc373cc 267 case 3:
Kovalev_D 209:224e7331a061 268 Gyro.Discharg = StartDischarg << ShiftStart3;
Kovalev_D 188:4c523cc373cc 269 Gyro.BackLight = StartBackLight << ShiftStart3;
Kovalev_D 188:4c523cc373cc 270 break;
Kovalev_D 205:775d54fdf646 271 }
Kovalev_D 205:775d54fdf646 272
Kovalev_D 88:b5c1d9d338d1 273 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 274 //////инициализация цап_LPC (р0.26 цап выход)////////
Kovalev_D 88:b5c1d9d338d1 275 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 276 LPC_PINCON->PINSEL1 = 0x00200000;
Kovalev_D 88:b5c1d9d338d1 277 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 278 ////////////начальное значение для цап///////////////
Kovalev_D 88:b5c1d9d338d1 279 //////////////////середина шкалы/////////////////////
Kovalev_D 88:b5c1d9d338d1 280 /////////////////////////////////////////////////////
Kovalev_D 205:775d54fdf646 281
Kovalev_D 86:398da56ef751 282 ////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 283 /////////////поправочный коэффициент/////////////////
Kovalev_D 86:398da56ef751 284 /////////для цапов (граници +-12.5 вольт)////////////
Kovalev_D 86:398da56ef751 285 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 286 K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2));
Kovalev_D 86:398da56ef751 287 K_DAC=0.8;
Kovalev_D 88:b5c1d9d338d1 288
Kovalev_D 86:398da56ef751 289 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 290 /////////////обнуление переменых для/////////////////
Kovalev_D 86:398da56ef751 291 ///////////////переменных энкодера///////////////////
Kovalev_D 86:398da56ef751 292 /////////////////////////////////////////////////////
Kovalev_D 205:775d54fdf646 293 secPuls =0;// переменная для конопки поджига аск глд(временная)
Kovalev_D 112:4a96133a1311 294 Gyro.CaunPlus =0;
Kovalev_D 112:4a96133a1311 295 Gyro.CaunMin =0;
Kovalev_D 88:b5c1d9d338d1 296 Cur_QEI=0;
Kovalev_D 86:398da56ef751 297 Last_QEI=0;
Kovalev_D 205:775d54fdf646 298 }
Kovalev_D 226:4a4d5bd5fcd7 299 void BUTTON_init(void) {
Kovalev_D 226:4a4d5bd5fcd7 300 LPC_GPIO0->FIODIR &= ~(1 << 1); /* PORT2.10 defined as input */
Kovalev_D 226:4a4d5bd5fcd7 301 LPC_GPIOINT->IO0IntEnF |= (1 << 1); /* enable falling edge irq */
Kovalev_D 205:775d54fdf646 302
Kovalev_D 226:4a4d5bd5fcd7 303 NVIC_EnableIRQ(EINT3_IRQn); /* enable irq in nvic */
Kovalev_D 226:4a4d5bd5fcd7 304 }
Kovalev_D 226:4a4d5bd5fcd7 305 /*void EINT3_IRQHandler()
Kovalev_D 226:4a4d5bd5fcd7 306 {
Kovalev_D 226:4a4d5bd5fcd7 307 if(Gyro.EXT_Latch)Gyro.EXT_Latch=0;
Kovalev_D 226:4a4d5bd5fcd7 308 else Gyro.EXT_Latch=1;
Kovalev_D 226:4a4d5bd5fcd7 309 LPC_GPIOINT->IO2IntClr |= (1 << 10);
Kovalev_D 226:4a4d5bd5fcd7 310 }*/
Kovalev_D 205:775d54fdf646 311 void GLD_Init(void)
Kovalev_D 214:4c70e452c491 312 {
Kovalev_D 214:4c70e452c491 313 int Dummy; // инициализация мусорки для очистки буфера приема.
Kovalev_D 226:4a4d5bd5fcd7 314 BUTTON_init();
Kovalev_D 214:4c70e452c491 315
Kovalev_D 222:7de7b3bf3a1d 316 if(Gyro.LG_Type==1)Spi.DAC_A=Gyro.HFO_Max;
Kovalev_D 214:4c70e452c491 317
Kovalev_D 214:4c70e452c491 318
Kovalev_D 214:4c70e452c491 319
Kovalev_D 86:398da56ef751 320 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 321 /////////////инициализация энкодера//////////////////
Kovalev_D 88:b5c1d9d338d1 322 /////////////////////////////////////////////////////
Kovalev_D 214:4c70e452c491 323
Kovalev_D 87:7e575d26d6d0 324 LPC_SC->PCONP |= (1<<18);//0x00040000; включение квадратурного энкодера.
Kovalev_D 170:d099c3025f87 325 LPC_SC->PCLKSEL1 |= 0x00000001; // выбор частоты для кв.э. CLK=103MHz
Kovalev_D 87:7e575d26d6d0 326 LPC_PINCON->PINSEL3 &= ~0x4100;
Kovalev_D 87:7e575d26d6d0 327 LPC_PINCON->PINSEL3 |= 0x4100; //P1.20, p1.23 установить как входы кв.э
Kovalev_D 89:a0d344db227e 328 LPC_PINCON->PINMODE3 |= 0x3C300; //P1.20, p1.23
Kovalev_D 86:398da56ef751 329
Kovalev_D 220:04c54405b82d 330 //Gyro.ShiftMod=150;
Kovalev_D 87:7e575d26d6d0 331 LPC_QEI->MAXPOS = MAX_QEI_CNT; //LPC_QEI->"регистор максимального положения" = 2147483646
Kovalev_D 89:a0d344db227e 332 LPC_QEI->FILTER = 2; // фильтр( ?? )
Kovalev_D 87:7e575d26d6d0 333 LPC_QEI->CON = 0xF; //сбросить в ноль все счетчики кв.э. (скорость, направление, позицию и тд)
Kovalev_D 214:4c70e452c491 334 LPC_QEI->CONF = (1<<2) |(0<<1); //Quadrature inputs, no inverting,only A pulses are counted
Kovalev_D 87:7e575d26d6d0 335
Kovalev_D 87:7e575d26d6d0 336 LPC_QEI->CLR = 0x1fff; //r. сбросить все прерывания
Kovalev_D 87:7e575d26d6d0 337 LPC_QEI->IEC = 0x1fff; //r. запретить прерывание при изменении направления
Kovalev_D 87:7e575d26d6d0 338
Kovalev_D 98:95b8e79f13e1 339 /*NVIC_SetPriority(QEI_IRQn, 0);
Kovalev_D 98:95b8e79f13e1 340 NVIC_EnableIRQ(QEI_IRQn);*/
Kovalev_D 88:b5c1d9d338d1 341 //////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 342 //////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 343
Kovalev_D 88:b5c1d9d338d1 344
Kovalev_D 89:a0d344db227e 345 //////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 346 ///////////////////////I2C////////////////////////////
Kovalev_D 89:a0d344db227e 347 //////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 348
Kovalev_D 89:a0d344db227e 349 LPC_SC->PCONP |= (1 << 19);//включение интерфейса I2C.
Kovalev_D 88:b5c1d9d338d1 350
Kovalev_D 89:a0d344db227e 351 /* set PIO0.27 and PIO0.28 to I2C0 SDA and SCK */
Kovalev_D 89:a0d344db227e 352 /* function to 01 on both SDA and SCK. */
Kovalev_D 89:a0d344db227e 353 LPC_PINCON->PINSEL1 &= ~0x03C00000; //P0.27 - SDA.
Kovalev_D 89:a0d344db227e 354 LPC_PINCON->PINSEL1 |= 0x01400000; //P0.28 - SCK.
Kovalev_D 86:398da56ef751 355
Kovalev_D 89:a0d344db227e 356 // подтверждение Флаг флаг разрешения
Kovalev_D 89:a0d344db227e 357 /*сброс флагоф флага прерывания I2C старта интерфейса I2C */
Kovalev_D 89:a0d344db227e 358 LPC_I2C0->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC | I2CONCLR_I2ENC; // установка микроконтроллера в режим мастера
Kovalev_D 86:398da56ef751 359
Kovalev_D 89:a0d344db227e 360 /*--- Reset registers ---*/
Kovalev_D 89:a0d344db227e 361 LPC_I2C0->SCLL = I2SCLL_SCLL; // - счетчик scl low time period
Kovalev_D 89:a0d344db227e 362 LPC_I2C0->SCLH = I2SCLH_SCLH; // - счетчик scl high time period
Kovalev_D 99:3d8f206ceac2 363
Kovalev_D 99:3d8f206ceac2 364 I2CMasterBuffer[0] = A_ADDRESS;
Kovalev_D 99:3d8f206ceac2 365 I2CMasterBuffer[1] = WRITE_CMD;
Kovalev_D 99:3d8f206ceac2 366 I2CMasterBuffer[3] = B_ADDRESS;
Kovalev_D 99:3d8f206ceac2 367 I2CMasterBuffer[4] = WRITE_CMD;
Kovalev_D 99:3d8f206ceac2 368
Kovalev_D 89:a0d344db227e 369 LPC_I2C0->CONSET = I2CONSET_I2EN; //включение интерфейса I2C.
Kovalev_D 89:a0d344db227e 370 //////////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 371 //////////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 372
Kovalev_D 86:398da56ef751 373
Kovalev_D 86:398da56ef751 374
Kovalev_D 92:c892f0311aa7 375
Kovalev_D 92:c892f0311aa7 376
Kovalev_D 92:c892f0311aa7 377
Kovalev_D 92:c892f0311aa7 378 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 379 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 380 //////////////////////////SPI//////////////////////////
Kovalev_D 92:c892f0311aa7 381 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 382 Dummy = Dummy;
Kovalev_D 92:c892f0311aa7 383
Kovalev_D 92:c892f0311aa7 384 /* Enable AHB clock to the SSP0, SSP1 */
Kovalev_D 92:c892f0311aa7 385 LPC_SC->PCONP |= (0x1<<21); // включение SSP0.
Kovalev_D 92:c892f0311aa7 386
Kovalev_D 92:c892f0311aa7 387 /* выбор частоты для переферии используем по умолчания с делителем основной на 4 */
Kovalev_D 92:c892f0311aa7 388 LPC_SC->PCLKSEL1 &= ~(0x3<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8
Kovalev_D 92:c892f0311aa7 389 LPC_SC->PCLKSEL1 |= (0x0<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/
Kovalev_D 92:c892f0311aa7 390
Kovalev_D 92:c892f0311aa7 391 // P0.15~0.18 as SSP0
Kovalev_D 92:c892f0311aa7 392 LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); //установит Р 0.15
Kovalev_D 92:c892f0311aa7 393 LPC_PINCON->PINSEL0 |= (0x2UL<<30); //частота для синхронизациии Master - slave
Kovalev_D 92:c892f0311aa7 394
Kovalev_D 92:c892f0311aa7 395 LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); // устанивоить Р 0.17 и Р 0.18
Kovalev_D 92:c892f0311aa7 396 LPC_PINCON->PINSEL1 |= ((0x2<<2)|(0x2<<4)); // как MISO0 и MOSI0
Kovalev_D 92:c892f0311aa7 397
Kovalev_D 92:c892f0311aa7 398 LPC_PINCON->PINMODE0 &= ~(0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 399 LPC_PINCON->PINMODE0 |= (0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 400
Kovalev_D 92:c892f0311aa7 401 LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 402 LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 403
Kovalev_D 92:c892f0311aa7 404 LPC_SSP0->CR0 = ((3<<8)|(0<<7)|(0<<4) |0xF); // (0xF)-установление DSS(Data sise select) в 16-битный формат, (3<<8 scr - выбор частоты),
Kovalev_D 92:c892f0311aa7 405 // низкий уровень линии тактирования между кадрами, прикрепление передачи к первому нарастанию тактового мигнала
Kovalev_D 92:c892f0311aa7 406 // формат кадра TI.
Kovalev_D 92:c892f0311aa7 407
Kovalev_D 92:c892f0311aa7 408 /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */
Kovalev_D 92:c892f0311aa7 409 LPC_SSP0->CPSR = 0x2; // freq = CLK/(cpsdvr*(scr+1)) = 1.6 MHz
Kovalev_D 92:c892f0311aa7 410
Kovalev_D 92:c892f0311aa7 411 /*SSP enable, master mode */
Kovalev_D 92:c892f0311aa7 412 LPC_SSP0->CR1 = SSPCR1_SSE;
Kovalev_D 92:c892f0311aa7 413 // LPC_SSP1->CR1 = SSPCR1_SSE;
Kovalev_D 190:289514f730ee 414 while (LPC_SSP0->SR & SSP_BUSY);
Kovalev_D 92:c892f0311aa7 415 while (LPC_SSP0->SR & RX_SSP_notEMPT) /* clear the RxFIFO */
Kovalev_D 92:c892f0311aa7 416 Dummy = LPC_SSP0->DR;
Kovalev_D 92:c892f0311aa7 417 //all pins after reset is in GPIO mode, so CS pins needn't to configure
Kovalev_D 92:c892f0311aa7 418 LPC_GPIO0->FIODIR |= (1<<16); // P0.16 defined as CS for ADC
Kovalev_D 92:c892f0311aa7 419 LPC_GPIO0->FIOSET |= (1<<16); // set CS for ADC
Kovalev_D 92:c892f0311aa7 420
Kovalev_D 92:c892f0311aa7 421 LPC_GPIO0->FIODIR |= (1<<23); // P defined as CS for DAC
Kovalev_D 92:c892f0311aa7 422 LPC_GPIO0->FIOCLR |= (1<<23); // set CS for DAC
Kovalev_D 92:c892f0311aa7 423 while (LPC_SSP1->SR & RX_SSP_notEMPT)
Kovalev_D 92:c892f0311aa7 424 Dummy = LPC_SSP1->DR; /* clear the RxFIFO */
Kovalev_D 92:c892f0311aa7 425 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 426 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 427 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 428
Kovalev_D 92:c892f0311aa7 429
Kovalev_D 92:c892f0311aa7 430
Kovalev_D 92:c892f0311aa7 431
Kovalev_D 86:398da56ef751 432 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 433 /////////////////инициализация ног///////////////////
Kovalev_D 86:398da56ef751 434 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 435
Kovalev_D 89:a0d344db227e 436 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 437 Gyro.PinRegOld = 0xffffffff;
Kovalev_D 88:b5c1d9d338d1 438 Gyro.PinReg = 0; // всЁ выключенно
Kovalev_D 88:b5c1d9d338d1 439 PinCheng();
Kovalev_D 89:a0d344db227e 440 /////////////////////////////////////////////////////
Kovalev_D 193:a0fe8bfc97e4 441 Gyro.ModeOut=0;
Kovalev_D 87:7e575d26d6d0 442 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 443 //////////////отладочный светодиод///////////////////
Kovalev_D 87:7e575d26d6d0 444 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 445
Kovalev_D 98:95b8e79f13e1 446 LPC_PINCON->PINSEL0 &= ~(0x00<<28);
Kovalev_D 214:4c70e452c491 447 LPC_PINCON->PINSEL0 |= (0x00<<28);
Kovalev_D 190:289514f730ee 448 LPC_PINCON->PINMODE0 |= (0x3<<28);
Kovalev_D 190:289514f730ee 449 LPC_GPIO1->FIODIR |= (1<<30);
Kovalev_D 87:7e575d26d6d0 450 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 451 /////////////////////////////////////////////////////
Kovalev_D 193:a0fe8bfc97e4 452 NVIC_EnableIRQ(EINT3_IRQn);
Kovalev_D 193:a0fe8bfc97e4 453 LPC_GPIOINT->IO0IntEnR |= (1<<1); /* enable rasing edge irq */
Kovalev_D 87:7e575d26d6d0 454 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 455 ////////////////управление уартом////////////////////
Kovalev_D 87:7e575d26d6d0 456 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 457 LPC_GPIO2->FIODIR |= (1<<7);//направление ноги uart enable
Kovalev_D 87:7e575d26d6d0 458 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 459 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 460
Kovalev_D 88:b5c1d9d338d1 461
Kovalev_D 88:b5c1d9d338d1 462
Kovalev_D 87:7e575d26d6d0 463 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 464 ///////////////////////поджиг////////////////////////
Kovalev_D 88:b5c1d9d338d1 465 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 466 LPC_PINCON->PINSEL0 &= ~(3<<8); //e. P0.4 is GPIO pin (запись ( 00 ) в 9:8 бит PISEL0 выбор P0.4 как GPIO)
Kovalev_D 98:95b8e79f13e1 467 LPC_PINCON->PINMODE0 |= (3<<8); //e. P0.4 is GPIO pin (запись ( 11 ) в 9:8 бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 226:4a4d5bd5fcd7 468 LPC_GPIO0->FIODIR |= (1<<4); //e. P0.4 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.4 как выход)
Kovalev_D 87:7e575d26d6d0 469 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 470 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 471
Kovalev_D 88:b5c1d9d338d1 472
Kovalev_D 88:b5c1d9d338d1 473
Kovalev_D 87:7e575d26d6d0 474 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 475 /////////////////////вибро 1/////////////////////////
Kovalev_D 87:7e575d26d6d0 476 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 477 LPC_PINCON->PINSEL3 &= ~(0x00<<18); //e. P1.25 is GPIO pin
Kovalev_D 98:95b8e79f13e1 478 LPC_PINCON->PINSEL3 |= (0x00<<18); //e. P1.25 is GPIO pin
Kovalev_D 87:7e575d26d6d0 479 LPC_PINCON->PINMODE3 |= (3<<18); //e. P1.25 (включениe подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 480 LPC_GPIO1->FIODIR |= (1<<25); //e. P0.5 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 481 LPC_GPIO1->FIOCLR |= (1<<25);
Kovalev_D 88:b5c1d9d338d1 482 //////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 483 //////////////////////вибро 2/////////////////////////
Kovalev_D 89:a0d344db227e 484 //////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 485 LPC_PINCON->PINSEL3 &= ~(0x00<<24); //e. P1.28 is GPIO pin
Kovalev_D 98:95b8e79f13e1 486 LPC_PINCON->PINSEL3 |= (0x00<<24); //e. P1.28 is GPIO pin
Kovalev_D 87:7e575d26d6d0 487 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (запись ( 11 ) в бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 488 LPC_GPIO1->FIODIR |= (1<<28); //e. P1.28 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 489 LPC_GPIO1->FIOCLR |= (1<<28);
Kovalev_D 87:7e575d26d6d0 490 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 491 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 492
Kovalev_D 88:b5c1d9d338d1 493
Kovalev_D 88:b5c1d9d338d1 494
Kovalev_D 87:7e575d26d6d0 495 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 496 /////////////инициализация подсветки/////////////////
Kovalev_D 87:7e575d26d6d0 497 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 498 LPC_PINCON->PINSEL2 &= ~(0x00<<24);
Kovalev_D 98:95b8e79f13e1 499 LPC_PINCON->PINSEL2 |= (0x00<<24); //e. P2.12 is GPIO pin
Kovalev_D 87:7e575d26d6d0 500 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (запись ( 11 ) в бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 501 LPC_GPIO2->FIODIR |= (1<<12); //e. P1.28 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 502 LPC_GPIO2->FIOCLR |= (1<<12);
Kovalev_D 88:b5c1d9d338d1 503 ///////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 504 ///////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 505
Kovalev_D 88:b5c1d9d338d1 506
Kovalev_D 88:b5c1d9d338d1 507 ///////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 508 ///////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 509 ///////////////////включение таймеров//////////////////
Kovalev_D 89:a0d344db227e 510 ///////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 511 enable_timer1();
Kovalev_D 86:398da56ef751 512 enable_timer2();
Kovalev_D 89:a0d344db227e 513 ///////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 514
Kovalev_D 89:a0d344db227e 515 //////////////////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 516 // LPC_GPIO0->FIOCLR = (1<<5);/////////////отключение поджига
Kovalev_D 90:d9b6a4bc5065 517
Kovalev_D 90:d9b6a4bc5065 518
Kovalev_D 90:d9b6a4bc5065 519
Kovalev_D 90:d9b6a4bc5065 520 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 521 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 522 //////////////////////////SPI//////////////////////////
Kovalev_D 90:d9b6a4bc5065 523 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 524 Dummy = Dummy;
Kovalev_D 90:d9b6a4bc5065 525
Kovalev_D 90:d9b6a4bc5065 526 /* Enable AHB clock to the SSP0, SSP1 */
Kovalev_D 90:d9b6a4bc5065 527 LPC_SC->PCONP |= (0x1<<21); // включение SSP0.
Kovalev_D 90:d9b6a4bc5065 528
Kovalev_D 90:d9b6a4bc5065 529 /* выбор частоты для переферии используем по умолчания с делителем основной на 4 */
Kovalev_D 90:d9b6a4bc5065 530 LPC_SC->PCLKSEL1 &= ~(0x3<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8
Kovalev_D 90:d9b6a4bc5065 531 LPC_SC->PCLKSEL1 |= (0x0<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/
Kovalev_D 90:d9b6a4bc5065 532
Kovalev_D 90:d9b6a4bc5065 533 // P0.15~0.18 as SSP0
Kovalev_D 90:d9b6a4bc5065 534 LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); //установит Р 0.15
Kovalev_D 90:d9b6a4bc5065 535 LPC_PINCON->PINSEL0 |= (0x2UL<<30); //частота для синхронизациии Master - slave
Kovalev_D 90:d9b6a4bc5065 536
Kovalev_D 90:d9b6a4bc5065 537 LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); // устанивоить Р 0.17 и Р 0.18
Kovalev_D 90:d9b6a4bc5065 538 LPC_PINCON->PINSEL1 |= ((0x2<<2)|(0x2<<4)); // как MISO0 и MOSI0
Kovalev_D 90:d9b6a4bc5065 539
Kovalev_D 90:d9b6a4bc5065 540 LPC_PINCON->PINMODE0 &= ~(0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 541 LPC_PINCON->PINMODE0 |= (0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 542
Kovalev_D 90:d9b6a4bc5065 543 LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 544 LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 545
Kovalev_D 90:d9b6a4bc5065 546 LPC_SSP0->CR0 = ((3<<8)|(0<<7)|(0<<4) |0xF); // (0xF)-установление DSS(Data sise select) в 16-битный формат, (3<<8 scr - выбор частоты),
Kovalev_D 90:d9b6a4bc5065 547 // низкий уровень линии тактирования между кадрами, прикрепление передачи к первому нарастанию тактового мигнала
Kovalev_D 90:d9b6a4bc5065 548 // формат кадра TI.
Kovalev_D 90:d9b6a4bc5065 549
Kovalev_D 90:d9b6a4bc5065 550 /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */
Kovalev_D 90:d9b6a4bc5065 551 LPC_SSP0->CPSR = 0x2; // freq = CLK/(cpsdvr*(scr+1)) = 1.6 MHz
Kovalev_D 90:d9b6a4bc5065 552
Kovalev_D 90:d9b6a4bc5065 553 /*SSP enable, master mode */
Kovalev_D 90:d9b6a4bc5065 554 LPC_SSP0->CR1 = SSPCR1_SSE;
Kovalev_D 90:d9b6a4bc5065 555 // LPC_SSP1->CR1 = SSPCR1_SSE;
Kovalev_D 90:d9b6a4bc5065 556 while (LPC_SSP0->SR & SSP_BUSY);
Kovalev_D 170:d099c3025f87 557 while (LPC_SSP0->SR & RX_SSP_notEMPT) /* clear the RxFIFO */
Kovalev_D 90:d9b6a4bc5065 558 Dummy = LPC_SSP0->DR;
Kovalev_D 90:d9b6a4bc5065 559 //all pins after reset is in GPIO mode, so CS pins needn't to configure
Kovalev_D 90:d9b6a4bc5065 560 LPC_GPIO0->FIODIR |= (1<<16); // P0.16 defined as CS for ADC
Kovalev_D 90:d9b6a4bc5065 561 LPC_GPIO0->FIOSET |= (1<<16); // set CS for ADC
Kovalev_D 90:d9b6a4bc5065 562
Kovalev_D 92:c892f0311aa7 563 LPC_GPIO0->FIODIR |= (1<<23); // P defined as CS for DAC
Kovalev_D 92:c892f0311aa7 564 LPC_GPIO0->FIOCLR |= (1<<23); // set CS for DAC
Kovalev_D 92:c892f0311aa7 565 while (LPC_SSP1->SR & RX_SSP_notEMPT)
Kovalev_D 92:c892f0311aa7 566 Dummy = LPC_SSP1->DR; /* clear the RxFIFO */
Kovalev_D 205:775d54fdf646 567 //Gyro=GyroP.str;
Kovalev_D 205:775d54fdf646 568 //Gyro = (*(struct Gyro*)(&GyroP.Str));
Kovalev_D 90:d9b6a4bc5065 569
Kovalev_D 86:398da56ef751 570 }
igor_v 13:e2a1d18677b8 571
igor_v 0:8ad47e2b6f00 572
igor_v 0:8ad47e2b6f00 573
igor_v 0:8ad47e2b6f00 574
igor_v 0:8ad47e2b6f00 575