Dmitry Kovalev / Mbed 2 deprecated LGfiltr

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of LGstaandart by Dmitry Kovalev

Global.c@141:c6de20b9b483, 2016-04-26 (annotated)

Committer:
Kovalev_D
Date:
Tue Apr 26 13:42:09 2016 +0000
Revision:
141:c6de20b9b483
Parent:
140:1fbf117fc120
Child:
142:7a6f68601291
?????? ??? ?????????? ??????? ???????????  ?????????, ??????????? ????????? ???????????.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
igor_v 0:8ad47e2b6f00 1 #include "Global.h"
igor_v 0:8ad47e2b6f00 2
igor_v 0:8ad47e2b6f00 3
igor_v 0:8ad47e2b6f00 4
Kovalev_D 89:a0d344db227e 5 unsigned int VibroReg = 0; //регистр состаяния вибропривода.
Kovalev_D 89:a0d344db227e 6 unsigned long Global_Time, Time_UART,Time_Sec,Time_vibro,Time_1kHz;
Kovalev_D 112:4a96133a1311 7
Kovalev_D 89:a0d344db227e 8 unsigned char BuffTemp[100];
Kovalev_D 89:a0d344db227e 9 unsigned char Time[500];
Kovalev_D 86:398da56ef751 10 unsigned int Event1Hz;
Kovalev_D 124:9ae09249f842 11 unsigned int Event500Hz;
Kovalev_D 88:b5c1d9d338d1 12 unsigned int Event1K ;
Kovalev_D 88:b5c1d9d338d1 13 unsigned int Event100K;
Kovalev_D 88:b5c1d9d338d1 14 unsigned int EventVibro;
Kovalev_D 124:9ae09249f842 15
Kovalev_D 124:9ae09249f842 16 unsigned int Time100K;
Kovalev_D 88:b5c1d9d338d1 17 unsigned int Time1K;
Kovalev_D 124:9ae09249f842 18 unsigned int Time500Hz;
Kovalev_D 88:b5c1d9d338d1 19 unsigned int Time1Hz;
Kovalev_D 88:b5c1d9d338d1 20 unsigned int Clock1Hz;
Kovalev_D 86:398da56ef751 21 unsigned int ShiftD;
Kovalev_D 86:398da56ef751 22 unsigned int ShiftL;
Kovalev_D 86:398da56ef751 23
Kovalev_D 140:1fbf117fc120 24
Kovalev_D 139:1716152517aa 25
Kovalev_D 134:caf4c9cd5052 26 __asm void boot_jump( uint32_t address ){
Kovalev_D 134:caf4c9cd5052 27 LDR SP, [R0] ;Load new stack pointer address
Kovalev_D 134:caf4c9cd5052 28 LDR R0, [R0, #4] ;Load new program counter address
Kovalev_D 134:caf4c9cd5052 29 BX R0
Kovalev_D 134:caf4c9cd5052 30 }
Kovalev_D 134:caf4c9cd5052 31
Kovalev_D 86:398da56ef751 32 void GLD_Init(void)
Kovalev_D 86:398da56ef751 33 {
Kovalev_D 90:d9b6a4bc5065 34 int Dummy; // инициализация мусорки для очистки буфера приема.
Kovalev_D 89:a0d344db227e 35 /////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 36 ///////////инициализация таймеров////////////
Kovalev_D 89:a0d344db227e 37 /////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 38 Init_TIM1(TIME_INTERVAL ); //Timer 1: CCLK / 7812 = 12800.819Hz; Vibro: Timer1/32 = 400.025Hz; 10ms???
Kovalev_D 89:a0d344db227e 39 Init_TIM2(); //Timer 2: CCLK / 4 / 250 = 100kHz
Kovalev_D 89:a0d344db227e 40 /////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 41 /////////////////////////////////////////////
Kovalev_D 104:ab1cb4ff56b2 42 Gyro.RgConA = 0xffff;
Kovalev_D 104:ab1cb4ff56b2 43 Gyro.RgConB = 0xffff;
Kovalev_D 86:398da56ef751 44 /////////////////////////////////////////////
Kovalev_D 86:398da56ef751 45 ///////////обнуление счетчиков///////////////
Kovalev_D 86:398da56ef751 46 /////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 47 Global_Time = 0;
Kovalev_D 88:b5c1d9d338d1 48 Time_UART = 0;
Kovalev_D 88:b5c1d9d338d1 49 Time_Sec = 0;
Kovalev_D 88:b5c1d9d338d1 50 Time_vibro = 0;
Kovalev_D 88:b5c1d9d338d1 51 Time_1kHz = 0;
Kovalev_D 88:b5c1d9d338d1 52 Event1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 53 Event1K = 0;
Kovalev_D 88:b5c1d9d338d1 54 Event100K = 0;
Kovalev_D 88:b5c1d9d338d1 55 EventVibro = 0;
Kovalev_D 88:b5c1d9d338d1 56 Time1K = 0;
Kovalev_D 88:b5c1d9d338d1 57 Time100K = 0;
Kovalev_D 88:b5c1d9d338d1 58 Time1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 59 Clock1Hz = 0;
Kovalev_D 88:b5c1d9d338d1 60 ShiftD = 0;
Kovalev_D 88:b5c1d9d338d1 61 ShiftL = 0;
Kovalev_D 124:9ae09249f842 62 Event500Hz = 0;
Kovalev_D 124:9ae09249f842 63 Time500Hz = 0;
Kovalev_D 139:1716152517aa 64
Kovalev_D 140:1fbf117fc120 65 Gyro.StrayHZ = 1000;
Kovalev_D 140:1fbf117fc120 66 Gyro.StrayHZ_flag = 0;
Kovalev_D 140:1fbf117fc120 67 Gyro.LogHZ = 0;
Kovalev_D 140:1fbf117fc120 68
Kovalev_D 141:c6de20b9b483 69 Gyro.StrayPLC =1000;
Kovalev_D 141:c6de20b9b483 70 Gyro.StrayPLC_2Mode = 2000;
Kovalev_D 140:1fbf117fc120 71 Gyro.StrayPLC_flag = 0;
Kovalev_D 141:c6de20b9b483 72 Gyro.LogPLC = 0;
Kovalev_D 86:398da56ef751 73 /////////////////////////////////////////////
Kovalev_D 86:398da56ef751 74 /////////////////////////////////////////////
Kovalev_D 86:398da56ef751 75
Kovalev_D 88:b5c1d9d338d1 76
Kovalev_D 88:b5c1d9d338d1 77 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 78 /////////////обнуление переменых для/////////////////
Kovalev_D 88:b5c1d9d338d1 79 ///////////расчета значений буферов ВП///////////////
Kovalev_D 88:b5c1d9d338d1 80 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 81 /////////////инициализация переменных в структ вибро/////////////////
Kovalev_D 132:2c7bec5cf6fe 82 Gyro.FlashMod=0;
Kovalev_D 99:3d8f206ceac2 83 Gyro.FrqHZ=400;
Kovalev_D 88:b5c1d9d338d1 84 Gyro.Frq = Gyro.FrqHZ<<16;
Kovalev_D 88:b5c1d9d338d1 85 Gyro.AmpPer=20;
Kovalev_D 88:b5c1d9d338d1 86 Gyro.AmpPerDel=10;
Kovalev_D 88:b5c1d9d338d1 87 Gyro.Amp = 10*65535;
Kovalev_D 88:b5c1d9d338d1 88 Gyro.AmpMin =10;// минимальное значение AmpT;
Kovalev_D 88:b5c1d9d338d1 89 Gyro.AmpTD =30;// максимальное значение AmpT; (AmpT частота ошумления)
Kovalev_D 88:b5c1d9d338d1 90 //////////////////////////////////////////////////////////////////////
Kovalev_D 106:250ddd8629c6 91 Gyro.CuruAngle = 0;
Kovalev_D 88:b5c1d9d338d1 92 Pulse_8Point = 0;
Kovalev_D 88:b5c1d9d338d1 93 Pulse_16Point = 0;
Kovalev_D 88:b5c1d9d338d1 94 Pulse_16PointD = 0;
Kovalev_D 88:b5c1d9d338d1 95 Pulse_32Point = 0;
Kovalev_D 88:b5c1d9d338d1 96 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 97 /////////////предварительное заполнение//////////////
Kovalev_D 88:b5c1d9d338d1 98 ////////////////буферов вибропривода/////////////////
Kovalev_D 88:b5c1d9d338d1 99 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 100 for (int i = 0; i < 32; i++ ) {
Kovalev_D 88:b5c1d9d338d1 101 Buff_16Point[i] = 0x00;
Kovalev_D 88:b5c1d9d338d1 102 Buff_8Point[i] = 0x00;
Kovalev_D 88:b5c1d9d338d1 103 Buff_32Point[i] = 0x00;
Kovalev_D 88:b5c1d9d338d1 104 Buff_16PointD[i] = 0x00;
Kovalev_D 129:406995a91322 105 GyroP.Array[i] = 0x00;
Kovalev_D 129:406995a91322 106 }
Kovalev_D 129:406995a91322 107
Kovalev_D 129:406995a91322 108 for (int i = 0; i < 170; i++ ) {
Kovalev_D 129:406995a91322 109 GyroP.Array[i] =i;
Kovalev_D 88:b5c1d9d338d1 110 }
Kovalev_D 88:b5c1d9d338d1 111 ////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 112 ////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 113 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 114 /////////////обнуление переменых для/////////////////
Kovalev_D 88:b5c1d9d338d1 115 //////////////////переменных АЦП/////////////////////
Kovalev_D 88:b5c1d9d338d1 116 /////////////////////////////////////////////////////
Kovalev_D 112:4a96133a1311 117 // Temp_AMP=0;
Kovalev_D 96:1c8536458119 118 Temp_AMP64P=0;
Kovalev_D 88:b5c1d9d338d1 119 Temp_ADC_2=0;
Kovalev_D 88:b5c1d9d338d1 120 Temp_ADC_3=0;
Kovalev_D 88:b5c1d9d338d1 121 Temp_ADC_4=0;
Kovalev_D 88:b5c1d9d338d1 122 Temp_ADC_5=0;
Kovalev_D 88:b5c1d9d338d1 123 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 124 /////////////предварительное заполнение//////////////
Kovalev_D 88:b5c1d9d338d1 125 /////////////////////буферов АЦП/////////////////////
Kovalev_D 88:b5c1d9d338d1 126 /////////////////////////////////////////////////////
Kovalev_D 95:dd51e577e114 127 for (int i = 0; i < 32; i++ ) {
Kovalev_D 88:b5c1d9d338d1 128 Buff_ADC_1[i] = 0; // ампл ацп.
Kovalev_D 88:b5c1d9d338d1 129 Buff_ADC_2[i] = 0;
Kovalev_D 88:b5c1d9d338d1 130 Buff_ADC_3[i] = 0;
Kovalev_D 88:b5c1d9d338d1 131 Buff_ADC_4[i] = 0;
Kovalev_D 95:dd51e577e114 132 }
Kovalev_D 95:dd51e577e114 133 for (int i = 0; i < 256; i++ ) {
Kovalev_D 95:dd51e577e114 134 Buff_ADC_5[i]= 0;
Kovalev_D 88:b5c1d9d338d1 135 }
Kovalev_D 96:1c8536458119 136 for (int i = 0; i < 256; i++ ) {
Kovalev_D 96:1c8536458119 137 Buff_AMP64P[i]= 0;
Kovalev_D 96:1c8536458119 138 }
Kovalev_D 96:1c8536458119 139 for (int i = 0; i < 256; i++ ) {
Kovalev_D 96:1c8536458119 140 Buff_AMP[i]= 0;
Kovalev_D 96:1c8536458119 141 }
Kovalev_D 88:b5c1d9d338d1 142 ////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 143 ////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 144
Kovalev_D 88:b5c1d9d338d1 145
Kovalev_D 88:b5c1d9d338d1 146
Kovalev_D 88:b5c1d9d338d1 147
Kovalev_D 88:b5c1d9d338d1 148
Kovalev_D 92:c892f0311aa7 149
Kovalev_D 88:b5c1d9d338d1 150 Gyro.SOC_Out=0xDD;
Kovalev_D 86:398da56ef751 151 Gyro.Firmware_Version =0x15; //версия программы
Kovalev_D 86:398da56ef751 152 Gyro.GLD_Serial = 0x20; //серийный номер
Kovalev_D 86:398da56ef751 153 Gyro.My_Addres = 0; //адрес глд
Kovalev_D 86:398da56ef751 154 Gyro.Discharg = StartDischarg;
Kovalev_D 86:398da56ef751 155 Gyro.BackLight = StartBackLight;
Kovalev_D 92:c892f0311aa7 156
Kovalev_D 88:b5c1d9d338d1 157
Kovalev_D 89:a0d344db227e 158
Kovalev_D 89:a0d344db227e 159
Kovalev_D 88:b5c1d9d338d1 160 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 161 //////инициализация цап_LPC (р0.26 цап выход)////////
Kovalev_D 88:b5c1d9d338d1 162 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 163 LPC_PINCON->PINSEL1 = 0x00200000;
Kovalev_D 88:b5c1d9d338d1 164 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 165 ////////////начальное значение для цап///////////////
Kovalev_D 88:b5c1d9d338d1 166 //////////////////середина шкалы/////////////////////
Kovalev_D 88:b5c1d9d338d1 167 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 168 Spi.DAC_A = 0x7fff;
Kovalev_D 86:398da56ef751 169 Spi.DAC_B = 0x7fff;
Kovalev_D 86:398da56ef751 170 ////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 171 /////////////поправочный коэффициент/////////////////
Kovalev_D 86:398da56ef751 172 /////////для цапов (граници +-12.5 вольт)////////////
Kovalev_D 86:398da56ef751 173 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 174 K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2));
Kovalev_D 86:398da56ef751 175 K_DAC=0.8;
Kovalev_D 88:b5c1d9d338d1 176 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 177 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 178
igor_v 16:18e3fd7b92d0 179
igor_v 16:18e3fd7b92d0 180
Kovalev_D 86:398da56ef751 181 secPuls =0;// переменная для конопки поджига аск глд(временная)
Kovalev_D 88:b5c1d9d338d1 182
Kovalev_D 86:398da56ef751 183
Kovalev_D 86:398da56ef751 184 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 185 /////////////обнуление переменых для/////////////////
Kovalev_D 86:398da56ef751 186 ///////////////переменных энкодера///////////////////
Kovalev_D 86:398da56ef751 187 /////////////////////////////////////////////////////
Kovalev_D 112:4a96133a1311 188 Gyro.CaunPlus =0;
Kovalev_D 112:4a96133a1311 189 Gyro.CaunMin =0;
Kovalev_D 88:b5c1d9d338d1 190 Cur_QEI=0;
Kovalev_D 86:398da56ef751 191 Last_QEI=0;
Kovalev_D 86:398da56ef751 192 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 193 /////////////инициализация энкодера//////////////////
Kovalev_D 88:b5c1d9d338d1 194 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 195 LPC_SC->PCONP |= (1<<18);//0x00040000; включение квадратурного энкодера.
Kovalev_D 87:7e575d26d6d0 196 LPC_SC->PCLKSEL1 |= 0x00000001; // выбор частоты для кв.э. CLK=100MHz
Kovalev_D 87:7e575d26d6d0 197 LPC_PINCON->PINSEL3 &= ~0x4100;
Kovalev_D 87:7e575d26d6d0 198 LPC_PINCON->PINSEL3 |= 0x4100; //P1.20, p1.23 установить как входы кв.э
Kovalev_D 89:a0d344db227e 199 LPC_PINCON->PINMODE3 |= 0x3C300; //P1.20, p1.23
Kovalev_D 86:398da56ef751 200
Kovalev_D 98:95b8e79f13e1 201
Kovalev_D 87:7e575d26d6d0 202 LPC_QEI->MAXPOS = MAX_QEI_CNT; //LPC_QEI->"регистор максимального положения" = 2147483646
Kovalev_D 89:a0d344db227e 203 LPC_QEI->FILTER = 2; // фильтр( ?? )
Kovalev_D 87:7e575d26d6d0 204 LPC_QEI->CON = 0xF; //сбросить в ноль все счетчики кв.э. (скорость, направление, позицию и тд)
Kovalev_D 87:7e575d26d6d0 205 LPC_QEI->CONF = (0<<2) |(0<<1); //Quadrature inputs, no inverting,only A pulses are counted
Kovalev_D 87:7e575d26d6d0 206
Kovalev_D 87:7e575d26d6d0 207 LPC_QEI->CLR = 0x1fff; //r. сбросить все прерывания
Kovalev_D 87:7e575d26d6d0 208 LPC_QEI->IEC = 0x1fff; //r. запретить прерывание при изменении направления
Kovalev_D 87:7e575d26d6d0 209
Kovalev_D 98:95b8e79f13e1 210 /*NVIC_SetPriority(QEI_IRQn, 0);
Kovalev_D 98:95b8e79f13e1 211 NVIC_EnableIRQ(QEI_IRQn);*/
Kovalev_D 88:b5c1d9d338d1 212 //////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 213 //////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 214
Kovalev_D 88:b5c1d9d338d1 215
Kovalev_D 89:a0d344db227e 216 //////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 217 ///////////////////////I2C////////////////////////////
Kovalev_D 89:a0d344db227e 218 //////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 219
Kovalev_D 89:a0d344db227e 220 LPC_SC->PCONP |= (1 << 19);//включение интерфейса I2C.
Kovalev_D 88:b5c1d9d338d1 221
Kovalev_D 89:a0d344db227e 222 /* set PIO0.27 and PIO0.28 to I2C0 SDA and SCK */
Kovalev_D 89:a0d344db227e 223 /* function to 01 on both SDA and SCK. */
Kovalev_D 89:a0d344db227e 224 LPC_PINCON->PINSEL1 &= ~0x03C00000; //P0.27 - SDA.
Kovalev_D 89:a0d344db227e 225 LPC_PINCON->PINSEL1 |= 0x01400000; //P0.28 - SCK.
Kovalev_D 86:398da56ef751 226
Kovalev_D 89:a0d344db227e 227 // подтверждение Флаг флаг разрешения
Kovalev_D 89:a0d344db227e 228 /*сброс флагоф флага прерывания I2C старта интерфейса I2C */
Kovalev_D 89:a0d344db227e 229 LPC_I2C0->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC | I2CONCLR_I2ENC; // установка микроконтроллера в режим мастера
Kovalev_D 86:398da56ef751 230
Kovalev_D 89:a0d344db227e 231 /*--- Reset registers ---*/
Kovalev_D 89:a0d344db227e 232 LPC_I2C0->SCLL = I2SCLL_SCLL; // - счетчик scl low time period
Kovalev_D 89:a0d344db227e 233 LPC_I2C0->SCLH = I2SCLH_SCLH; // - счетчик scl high time period
Kovalev_D 99:3d8f206ceac2 234
Kovalev_D 99:3d8f206ceac2 235 I2CMasterBuffer[0] = A_ADDRESS;
Kovalev_D 99:3d8f206ceac2 236 I2CMasterBuffer[1] = WRITE_CMD;
Kovalev_D 99:3d8f206ceac2 237 I2CMasterBuffer[3] = B_ADDRESS;
Kovalev_D 99:3d8f206ceac2 238 I2CMasterBuffer[4] = WRITE_CMD;
Kovalev_D 99:3d8f206ceac2 239
Kovalev_D 89:a0d344db227e 240 LPC_I2C0->CONSET = I2CONSET_I2EN; //включение интерфейса I2C.
Kovalev_D 89:a0d344db227e 241 //////////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 242 //////////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 243
Kovalev_D 86:398da56ef751 244
Kovalev_D 86:398da56ef751 245
Kovalev_D 92:c892f0311aa7 246
Kovalev_D 92:c892f0311aa7 247
Kovalev_D 92:c892f0311aa7 248
Kovalev_D 92:c892f0311aa7 249 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 250 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 251 //////////////////////////SPI//////////////////////////
Kovalev_D 92:c892f0311aa7 252 ///////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 253 Dummy = Dummy;
Kovalev_D 92:c892f0311aa7 254
Kovalev_D 92:c892f0311aa7 255 /* Enable AHB clock to the SSP0, SSP1 */
Kovalev_D 92:c892f0311aa7 256 LPC_SC->PCONP |= (0x1<<21); // включение SSP0.
Kovalev_D 92:c892f0311aa7 257
Kovalev_D 92:c892f0311aa7 258 /* выбор частоты для переферии используем по умолчания с делителем основной на 4 */
Kovalev_D 92:c892f0311aa7 259 LPC_SC->PCLKSEL1 &= ~(0x3<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8
Kovalev_D 92:c892f0311aa7 260 LPC_SC->PCLKSEL1 |= (0x0<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/
Kovalev_D 92:c892f0311aa7 261
Kovalev_D 92:c892f0311aa7 262 // P0.15~0.18 as SSP0
Kovalev_D 92:c892f0311aa7 263 LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); //установит Р 0.15
Kovalev_D 92:c892f0311aa7 264 LPC_PINCON->PINSEL0 |= (0x2UL<<30); //частота для синхронизациии Master - slave
Kovalev_D 92:c892f0311aa7 265
Kovalev_D 92:c892f0311aa7 266 LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); // устанивоить Р 0.17 и Р 0.18
Kovalev_D 92:c892f0311aa7 267 LPC_PINCON->PINSEL1 |= ((0x2<<2)|(0x2<<4)); // как MISO0 и MOSI0
Kovalev_D 92:c892f0311aa7 268
Kovalev_D 92:c892f0311aa7 269 LPC_PINCON->PINMODE0 &= ~(0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 270 LPC_PINCON->PINMODE0 |= (0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 271
Kovalev_D 92:c892f0311aa7 272 LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 273 LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 92:c892f0311aa7 274
Kovalev_D 92:c892f0311aa7 275 LPC_SSP0->CR0 = ((3<<8)|(0<<7)|(0<<4) |0xF); // (0xF)-установление DSS(Data sise select) в 16-битный формат, (3<<8 scr - выбор частоты),
Kovalev_D 92:c892f0311aa7 276 // низкий уровень линии тактирования между кадрами, прикрепление передачи к первому нарастанию тактового мигнала
Kovalev_D 92:c892f0311aa7 277 // формат кадра TI.
Kovalev_D 92:c892f0311aa7 278
Kovalev_D 92:c892f0311aa7 279 /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */
Kovalev_D 92:c892f0311aa7 280 LPC_SSP0->CPSR = 0x2; // freq = CLK/(cpsdvr*(scr+1)) = 1.6 MHz
Kovalev_D 92:c892f0311aa7 281
Kovalev_D 92:c892f0311aa7 282 /*SSP enable, master mode */
Kovalev_D 92:c892f0311aa7 283 LPC_SSP0->CR1 = SSPCR1_SSE;
Kovalev_D 92:c892f0311aa7 284 // LPC_SSP1->CR1 = SSPCR1_SSE;
Kovalev_D 92:c892f0311aa7 285 while (LPC_SSP0->SR & SSP_BUSY);
Kovalev_D 92:c892f0311aa7 286 while (LPC_SSP0->SR & RX_SSP_notEMPT) /* clear the RxFIFO */
Kovalev_D 92:c892f0311aa7 287 Dummy = LPC_SSP0->DR;
Kovalev_D 92:c892f0311aa7 288 //all pins after reset is in GPIO mode, so CS pins needn't to configure
Kovalev_D 92:c892f0311aa7 289 LPC_GPIO0->FIODIR |= (1<<16); // P0.16 defined as CS for ADC
Kovalev_D 92:c892f0311aa7 290 LPC_GPIO0->FIOSET |= (1<<16); // set CS for ADC
Kovalev_D 92:c892f0311aa7 291
Kovalev_D 92:c892f0311aa7 292 LPC_GPIO0->FIODIR |= (1<<23); // P defined as CS for DAC
Kovalev_D 92:c892f0311aa7 293 LPC_GPIO0->FIOCLR |= (1<<23); // set CS for DAC
Kovalev_D 92:c892f0311aa7 294 while (LPC_SSP1->SR & RX_SSP_notEMPT)
Kovalev_D 92:c892f0311aa7 295 Dummy = LPC_SSP1->DR; /* clear the RxFIFO */
Kovalev_D 92:c892f0311aa7 296 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 297 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 298 /////////////////////////////////////////////////////////////////////////////////////////////////////////////
Kovalev_D 92:c892f0311aa7 299
Kovalev_D 92:c892f0311aa7 300
Kovalev_D 92:c892f0311aa7 301
Kovalev_D 92:c892f0311aa7 302
Kovalev_D 86:398da56ef751 303 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 304 /////////////////инициализация ног///////////////////
Kovalev_D 86:398da56ef751 305 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 306
Kovalev_D 89:a0d344db227e 307 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 308 Gyro.PinRegOld = 0xffffffff;
Kovalev_D 88:b5c1d9d338d1 309 Gyro.PinReg = 0; // всЁ выключенно
Kovalev_D 88:b5c1d9d338d1 310 PinCheng();
Kovalev_D 89:a0d344db227e 311 /////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 312
Kovalev_D 87:7e575d26d6d0 313 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 314 //////////////отладочный светодиод///////////////////
Kovalev_D 87:7e575d26d6d0 315 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 316
Kovalev_D 98:95b8e79f13e1 317 LPC_PINCON->PINSEL0 &= ~(0x00<<28);
Kovalev_D 98:95b8e79f13e1 318 LPC_PINCON->PINSEL0 |= (0x00<<28); // а нужно, ведь по умолчаниб у них 0 функция. попробоввать без них потом убрать
Kovalev_D 98:95b8e79f13e1 319 LPC_PINCON->PINMODE0 |= (0x3<<28);
Kovalev_D 87:7e575d26d6d0 320 LPC_GPIO1->FIODIR |= (1<<30);
Kovalev_D 87:7e575d26d6d0 321 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 322 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 323
Kovalev_D 88:b5c1d9d338d1 324
Kovalev_D 87:7e575d26d6d0 325 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 326 ////////////////управление уартом////////////////////
Kovalev_D 87:7e575d26d6d0 327 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 328 LPC_GPIO2->FIODIR |= (1<<7);//направление ноги uart enable
Kovalev_D 87:7e575d26d6d0 329 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 330 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 331
Kovalev_D 88:b5c1d9d338d1 332
Kovalev_D 88:b5c1d9d338d1 333
Kovalev_D 87:7e575d26d6d0 334 /////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 335 ///////////////////////поджиг////////////////////////
Kovalev_D 88:b5c1d9d338d1 336 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 337 LPC_PINCON->PINSEL0 &= ~(3<<8); //e. P0.4 is GPIO pin (запись ( 00 ) в 9:8 бит PISEL0 выбор P0.4 как GPIO)
Kovalev_D 98:95b8e79f13e1 338 LPC_PINCON->PINMODE0 |= (3<<8); //e. P0.4 is GPIO pin (запись ( 11 ) в 9:8 бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 339 LPC_GPIO0->FIODIR |= (1<<4); //e. P0.4 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.4 как выход)
Kovalev_D 87:7e575d26d6d0 340 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 341 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 342
Kovalev_D 88:b5c1d9d338d1 343
Kovalev_D 88:b5c1d9d338d1 344
Kovalev_D 87:7e575d26d6d0 345 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 346 /////////////////////вибро 1/////////////////////////
Kovalev_D 87:7e575d26d6d0 347 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 348 LPC_PINCON->PINSEL3 &= ~(0x00<<18); //e. P1.25 is GPIO pin
Kovalev_D 98:95b8e79f13e1 349 LPC_PINCON->PINSEL3 |= (0x00<<18); //e. P1.25 is GPIO pin
Kovalev_D 87:7e575d26d6d0 350 LPC_PINCON->PINMODE3 |= (3<<18); //e. P1.25 (включениe подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 351 LPC_GPIO1->FIODIR |= (1<<25); //e. P0.5 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 352 LPC_GPIO1->FIOCLR |= (1<<25);
Kovalev_D 88:b5c1d9d338d1 353 //////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 354 //////////////////////вибро 2/////////////////////////
Kovalev_D 89:a0d344db227e 355 //////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 356 LPC_PINCON->PINSEL3 &= ~(0x00<<24); //e. P1.28 is GPIO pin
Kovalev_D 98:95b8e79f13e1 357 LPC_PINCON->PINSEL3 |= (0x00<<24); //e. P1.28 is GPIO pin
Kovalev_D 87:7e575d26d6d0 358 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (запись ( 11 ) в бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 359 LPC_GPIO1->FIODIR |= (1<<28); //e. P1.28 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 360 LPC_GPIO1->FIOCLR |= (1<<28);
Kovalev_D 87:7e575d26d6d0 361 /////////////////////////////////////////////////////
Kovalev_D 87:7e575d26d6d0 362 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 363
Kovalev_D 88:b5c1d9d338d1 364
Kovalev_D 88:b5c1d9d338d1 365
Kovalev_D 87:7e575d26d6d0 366 /////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 367 /////////////инициализация подсветки/////////////////
Kovalev_D 87:7e575d26d6d0 368 /////////////////////////////////////////////////////
Kovalev_D 98:95b8e79f13e1 369 LPC_PINCON->PINSEL2 &= ~(0x00<<24);
Kovalev_D 98:95b8e79f13e1 370 LPC_PINCON->PINSEL2 |= (0x00<<24); //e. P2.12 is GPIO pin
Kovalev_D 87:7e575d26d6d0 371 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (запись ( 11 ) в бит PINMODE0 "для включения подтягивающего резистора")
Kovalev_D 87:7e575d26d6d0 372 LPC_GPIO2->FIODIR |= (1<<12); //e. P1.28 is output (запись ( 1 ) в 5 бит FIODIR выбор P0.5 как выход)
Kovalev_D 87:7e575d26d6d0 373 LPC_GPIO2->FIOCLR |= (1<<12);
Kovalev_D 88:b5c1d9d338d1 374 ///////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 375 ///////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 376
Kovalev_D 88:b5c1d9d338d1 377
Kovalev_D 88:b5c1d9d338d1 378 ///////////////////////////////////////////////////////
Kovalev_D 88:b5c1d9d338d1 379 ///////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 380 ///////////////////включение таймеров//////////////////
Kovalev_D 89:a0d344db227e 381 ///////////////////////////////////////////////////////
Kovalev_D 86:398da56ef751 382 enable_timer1();
Kovalev_D 86:398da56ef751 383 enable_timer2();
Kovalev_D 89:a0d344db227e 384 ///////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 385
Kovalev_D 89:a0d344db227e 386 //////////////////////////////////////////////////////////////////
Kovalev_D 89:a0d344db227e 387 // LPC_GPIO0->FIOCLR = (1<<5);/////////////отключение поджига
Kovalev_D 90:d9b6a4bc5065 388
Kovalev_D 90:d9b6a4bc5065 389
Kovalev_D 90:d9b6a4bc5065 390
Kovalev_D 90:d9b6a4bc5065 391 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 392 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 393 //////////////////////////SPI//////////////////////////
Kovalev_D 90:d9b6a4bc5065 394 ///////////////////////////////////////////////////////
Kovalev_D 90:d9b6a4bc5065 395 Dummy = Dummy;
Kovalev_D 90:d9b6a4bc5065 396
Kovalev_D 90:d9b6a4bc5065 397 /* Enable AHB clock to the SSP0, SSP1 */
Kovalev_D 90:d9b6a4bc5065 398 LPC_SC->PCONP |= (0x1<<21); // включение SSP0.
Kovalev_D 90:d9b6a4bc5065 399
Kovalev_D 90:d9b6a4bc5065 400 /* выбор частоты для переферии используем по умолчания с делителем основной на 4 */
Kovalev_D 90:d9b6a4bc5065 401 LPC_SC->PCLKSEL1 &= ~(0x3<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8
Kovalev_D 90:d9b6a4bc5065 402 LPC_SC->PCLKSEL1 |= (0x0<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/
Kovalev_D 90:d9b6a4bc5065 403
Kovalev_D 90:d9b6a4bc5065 404 // P0.15~0.18 as SSP0
Kovalev_D 90:d9b6a4bc5065 405 LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); //установит Р 0.15
Kovalev_D 90:d9b6a4bc5065 406 LPC_PINCON->PINSEL0 |= (0x2UL<<30); //частота для синхронизациии Master - slave
Kovalev_D 90:d9b6a4bc5065 407
Kovalev_D 90:d9b6a4bc5065 408 LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); // устанивоить Р 0.17 и Р 0.18
Kovalev_D 90:d9b6a4bc5065 409 LPC_PINCON->PINSEL1 |= ((0x2<<2)|(0x2<<4)); // как MISO0 и MOSI0
Kovalev_D 90:d9b6a4bc5065 410
Kovalev_D 90:d9b6a4bc5065 411 LPC_PINCON->PINMODE0 &= ~(0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 412 LPC_PINCON->PINMODE0 |= (0x3UL<<30);// ? установление на Р 0.15 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 413
Kovalev_D 90:d9b6a4bc5065 414 LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 415 LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4));// ? установление на Р 0.17 и Р 0.18 режима On-Chip pull-down resistor enabled
Kovalev_D 90:d9b6a4bc5065 416
Kovalev_D 90:d9b6a4bc5065 417 LPC_SSP0->CR0 = ((3<<8)|(0<<7)|(0<<4) |0xF); // (0xF)-установление DSS(Data sise select) в 16-битный формат, (3<<8 scr - выбор частоты),
Kovalev_D 90:d9b6a4bc5065 418 // низкий уровень линии тактирования между кадрами, прикрепление передачи к первому нарастанию тактового мигнала
Kovalev_D 90:d9b6a4bc5065 419 // формат кадра TI.
Kovalev_D 90:d9b6a4bc5065 420
Kovalev_D 90:d9b6a4bc5065 421 /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */
Kovalev_D 90:d9b6a4bc5065 422 LPC_SSP0->CPSR = 0x2; // freq = CLK/(cpsdvr*(scr+1)) = 1.6 MHz
Kovalev_D 90:d9b6a4bc5065 423
Kovalev_D 90:d9b6a4bc5065 424 /*SSP enable, master mode */
Kovalev_D 90:d9b6a4bc5065 425 LPC_SSP0->CR1 = SSPCR1_SSE;
Kovalev_D 90:d9b6a4bc5065 426 // LPC_SSP1->CR1 = SSPCR1_SSE;
Kovalev_D 90:d9b6a4bc5065 427 while (LPC_SSP0->SR & SSP_BUSY);
Kovalev_D 90:d9b6a4bc5065 428 while (LPC_SSP0->SR & RX_SSP_notEMPT) /* clear the RxFIFO */
Kovalev_D 90:d9b6a4bc5065 429 Dummy = LPC_SSP0->DR;
Kovalev_D 90:d9b6a4bc5065 430 //all pins after reset is in GPIO mode, so CS pins needn't to configure
Kovalev_D 90:d9b6a4bc5065 431 LPC_GPIO0->FIODIR |= (1<<16); // P0.16 defined as CS for ADC
Kovalev_D 90:d9b6a4bc5065 432 LPC_GPIO0->FIOSET |= (1<<16); // set CS for ADC
Kovalev_D 90:d9b6a4bc5065 433
Kovalev_D 92:c892f0311aa7 434 LPC_GPIO0->FIODIR |= (1<<23); // P defined as CS for DAC
Kovalev_D 92:c892f0311aa7 435 LPC_GPIO0->FIOCLR |= (1<<23); // set CS for DAC
Kovalev_D 92:c892f0311aa7 436 while (LPC_SSP1->SR & RX_SSP_notEMPT)
Kovalev_D 92:c892f0311aa7 437 Dummy = LPC_SSP1->DR; /* clear the RxFIFO */
Kovalev_D 90:d9b6a4bc5065 438
Kovalev_D 86:398da56ef751 439 }
igor_v 13:e2a1d18677b8 440
igor_v 0:8ad47e2b6f00 441
igor_v 0:8ad47e2b6f00 442
igor_v 0:8ad47e2b6f00 443
igor_v 0:8ad47e2b6f00 444