igor Apu / Mbed 2 deprecated LG Featured

123

Dependencies:   mbed

Fork of LG by igor Apu

Global.c@96:1c8536458119, 2016-03-28 (annotated)

Committer:
Kovalev_D
Date:
Mon Mar 28 15:23:40 2016 +0000
Revision:
96:1c8536458119
Parent:
95:dd51e577e114
Child:
98:95b8e79f13e1
1

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