STM32L476
Dependencies: MbedJSONValue SDFileSystem WConstants mbed-dev DS1820 TinyGPSPlus epd1in54
Fork of A_SSL_Main by
main.cpp@3:bc4495101c7b, 2018-08-22 (annotated)
- Committer:
- WaleedElmughrabi
- Date:
- Wed Aug 22 18:13:37 2018 +0000
- Revision:
- 3:bc4495101c7b
- Parent:
- 2:b14aac0ec647
- Child:
- 4:06edbeb05013
Display orientation, font, In Polygon
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bcostm | 0:eafcd0445e97 | 1 | #include "mbed.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 2 | #include "stm32l496g_discovery.h" |
bcostm | 0:eafcd0445e97 | 3 | #include "stm32l496g_discovery_lcd.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 4 | #include "stm32l496g_discovery_sd.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 5 | #include "DS1820.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 6 | #include "epd1in54.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 7 | #include "stdio.h" |
WaleedElmughrabi | 2:b14aac0ec647 | 8 | |
WaleedElmughrabi | 2:b14aac0ec647 | 9 | #define NUM_OF_BLOCKS 5 |
WaleedElmughrabi | 2:b14aac0ec647 | 10 | #define BLOCK_START_ADDR 0 |
WaleedElmughrabi | 2:b14aac0ec647 | 11 | #define BLOCK_SIZE 512 |
WaleedElmughrabi | 2:b14aac0ec647 | 12 | #define BLOCK_END_ADDR (BLOCK_SIZE * NUM_OF_BLOCKS) |
WaleedElmughrabi | 2:b14aac0ec647 | 13 | #define BUFFER_WORDS_SIZE ((BLOCK_SIZE * NUM_OF_BLOCKS) >> 2) // Total data size in bytes |
WaleedElmughrabi | 2:b14aac0ec647 | 14 | |
WaleedElmughrabi | 2:b14aac0ec647 | 15 | //DS18B20 temperature sensor |
WaleedElmughrabi | 2:b14aac0ec647 | 16 | Serial serial(USBTX, USBRX); |
WaleedElmughrabi | 2:b14aac0ec647 | 17 | DS1820 ds1820(PG_15); //pin name connected to the DS1820 data pin |
WaleedElmughrabi | 2:b14aac0ec647 | 18 | float t; |
WaleedElmughrabi | 3:bc4495101c7b | 19 | float tempSerial; |
WaleedElmughrabi | 3:bc4495101c7b | 20 | float tCompare = 0; |
WaleedElmughrabi | 3:bc4495101c7b | 21 | int ab=1; |
WaleedElmughrabi | 3:bc4495101c7b | 22 | |
WaleedElmughrabi | 2:b14aac0ec647 | 23 | |
WaleedElmughrabi | 2:b14aac0ec647 | 24 | //E-ink Display |
WaleedElmughrabi | 2:b14aac0ec647 | 25 | // Control |
WaleedElmughrabi | 2:b14aac0ec647 | 26 | PinName rst; |
WaleedElmughrabi | 2:b14aac0ec647 | 27 | PinName dc; |
WaleedElmughrabi | 2:b14aac0ec647 | 28 | PinName busy; |
WaleedElmughrabi | 2:b14aac0ec647 | 29 | //SPI communication |
WaleedElmughrabi | 2:b14aac0ec647 | 30 | PinName mosi; |
WaleedElmughrabi | 2:b14aac0ec647 | 31 | PinName miso; |
WaleedElmughrabi | 2:b14aac0ec647 | 32 | PinName sclk; |
WaleedElmughrabi | 2:b14aac0ec647 | 33 | PinName cs; |
WaleedElmughrabi | 2:b14aac0ec647 | 34 | unsigned char frame_black[EPD_HEIGHT*EPD_WIDTH/8]; |
WaleedElmughrabi | 2:b14aac0ec647 | 35 | |
WaleedElmughrabi | 2:b14aac0ec647 | 36 | uint32_t aTxBuffer[BUFFER_WORDS_SIZE]; |
WaleedElmughrabi | 2:b14aac0ec647 | 37 | uint32_t aRxBuffer[BUFFER_WORDS_SIZE]; |
WaleedElmughrabi | 2:b14aac0ec647 | 38 | |
WaleedElmughrabi | 3:bc4495101c7b | 39 | |
WaleedElmughrabi | 2:b14aac0ec647 | 40 | static void print_demo_title(void); |
WaleedElmughrabi | 3:bc4495101c7b | 41 | //static void print_PASS(void); |
WaleedElmughrabi | 2:b14aac0ec647 | 42 | static void print_FAIL(void); |
WaleedElmughrabi | 2:b14aac0ec647 | 43 | static void Fill_Buffer(uint32_t *pBuffer, uint32_t uwBufferLenght, uint32_t uwOffset); |
WaleedElmughrabi | 2:b14aac0ec647 | 44 | static uint8_t Buffercmp(uint32_t* pBuffer1, uint32_t* pBuffer2, uint16_t BufferLength); |
WaleedElmughrabi | 2:b14aac0ec647 | 45 | |
WaleedElmughrabi | 3:bc4495101c7b | 46 | |
WaleedElmughrabi | 3:bc4495101c7b | 47 | int pnpoly(int nvert, float *vertx, float *verty, float testx, float testy) |
WaleedElmughrabi | 3:bc4495101c7b | 48 | { |
WaleedElmughrabi | 3:bc4495101c7b | 49 | int i, j, c = 0; |
WaleedElmughrabi | 3:bc4495101c7b | 50 | for (i = 0, j = nvert-1; i < nvert; j = i++) { |
WaleedElmughrabi | 3:bc4495101c7b | 51 | if ( ((verty[i]>testy) != (verty[j]>testy)) && |
WaleedElmughrabi | 3:bc4495101c7b | 52 | (testx < (vertx[j]-vertx[i]) * (testy-verty[i]) / (verty[j]-verty[i]) + vertx[i]) ) |
WaleedElmughrabi | 3:bc4495101c7b | 53 | c = !c; |
WaleedElmughrabi | 3:bc4495101c7b | 54 | } |
WaleedElmughrabi | 3:bc4495101c7b | 55 | return c; |
WaleedElmughrabi | 3:bc4495101c7b | 56 | } |
WaleedElmughrabi | 3:bc4495101c7b | 57 | |
WaleedElmughrabi | 3:bc4495101c7b | 58 | |
WaleedElmughrabi | 2:b14aac0ec647 | 59 | float getTemp(float t) |
WaleedElmughrabi | 2:b14aac0ec647 | 60 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 61 | |
WaleedElmughrabi | 2:b14aac0ec647 | 62 | // getTemp(tRead); |
WaleedElmughrabi | 2:b14aac0ec647 | 63 | |
WaleedElmughrabi | 2:b14aac0ec647 | 64 | if(ds1820.begin()) { |
WaleedElmughrabi | 2:b14aac0ec647 | 65 | ds1820.startConversion(); |
WaleedElmughrabi | 2:b14aac0ec647 | 66 | wait(1.0); |
WaleedElmughrabi | 2:b14aac0ec647 | 67 | t = ds1820.read(); // read temperature |
WaleedElmughrabi | 3:bc4495101c7b | 68 | tCompare; |
WaleedElmughrabi | 2:b14aac0ec647 | 69 | serial.printf("temp = %3.1f\r\n", t); // Display temp on terminal |
WaleedElmughrabi | 2:b14aac0ec647 | 70 | |
WaleedElmughrabi | 2:b14aac0ec647 | 71 | } else |
WaleedElmughrabi | 2:b14aac0ec647 | 72 | serial.printf("No DS1820 sensor found!\r\n"); |
WaleedElmughrabi | 2:b14aac0ec647 | 73 | |
WaleedElmughrabi | 2:b14aac0ec647 | 74 | |
WaleedElmughrabi | 2:b14aac0ec647 | 75 | |
WaleedElmughrabi | 2:b14aac0ec647 | 76 | |
WaleedElmughrabi | 2:b14aac0ec647 | 77 | mosi = PB_5; |
WaleedElmughrabi | 2:b14aac0ec647 | 78 | miso = PB_4; |
WaleedElmughrabi | 2:b14aac0ec647 | 79 | sclk = PA_5; |
WaleedElmughrabi | 2:b14aac0ec647 | 80 | cs = PA_15; |
WaleedElmughrabi | 2:b14aac0ec647 | 81 | rst = PI_6; |
WaleedElmughrabi | 2:b14aac0ec647 | 82 | dc = PG_6; |
WaleedElmughrabi | 2:b14aac0ec647 | 83 | busy = PI_11; |
WaleedElmughrabi | 2:b14aac0ec647 | 84 | |
WaleedElmughrabi | 2:b14aac0ec647 | 85 | char cVal[32]; |
WaleedElmughrabi | 2:b14aac0ec647 | 86 | //char* t_str; |
WaleedElmughrabi | 2:b14aac0ec647 | 87 | sprintf(cVal,"%.2f", t); |
WaleedElmughrabi | 3:bc4495101c7b | 88 | |
WaleedElmughrabi | 3:bc4495101c7b | 89 | |
WaleedElmughrabi | 3:bc4495101c7b | 90 | |
WaleedElmughrabi | 2:b14aac0ec647 | 91 | memset(frame_black, 0xFF, sizeof(unsigned char)*EPD_HEIGHT*EPD_WIDTH/8); |
WaleedElmughrabi | 2:b14aac0ec647 | 92 | Epd epd = Epd(mosi, miso, sclk, cs, dc, rst, busy); |
WaleedElmughrabi | 3:bc4495101c7b | 93 | |
WaleedElmughrabi | 3:bc4495101c7b | 94 | |
WaleedElmughrabi | 2:b14aac0ec647 | 95 | if (epd.Init(lut_full_update) != 0) { |
WaleedElmughrabi | 2:b14aac0ec647 | 96 | return -1; |
WaleedElmughrabi | 2:b14aac0ec647 | 97 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 98 | /*Write strings to the buffer */ |
WaleedElmughrabi | 3:bc4495101c7b | 99 | epd.DrawStringAt(frame_black, 50, 30, cVal, &Font24, COLORED); |
WaleedElmughrabi | 2:b14aac0ec647 | 100 | epd.DrawStringAt(frame_black, 28, 10, "Temperature", &Font16, COLORED); |
WaleedElmughrabi | 2:b14aac0ec647 | 101 | /* Display the frame_buffer */ |
WaleedElmughrabi | 2:b14aac0ec647 | 102 | epd.SetFrameMemory(frame_black, 0, 0, epd.width, epd.height); |
WaleedElmughrabi | 2:b14aac0ec647 | 103 | epd.DisplayFrame(); |
WaleedElmughrabi | 2:b14aac0ec647 | 104 | epd.Sleep(); |
WaleedElmughrabi | 2:b14aac0ec647 | 105 | return t; |
WaleedElmughrabi | 2:b14aac0ec647 | 106 | } |
bcostm | 0:eafcd0445e97 | 107 | |
bcostm | 0:eafcd0445e97 | 108 | int main() |
bcostm | 0:eafcd0445e97 | 109 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 110 | uint8_t status; |
WaleedElmughrabi | 2:b14aac0ec647 | 111 | print_demo_title(); |
WaleedElmughrabi | 2:b14aac0ec647 | 112 | wait(0.2); |
WaleedElmughrabi | 2:b14aac0ec647 | 113 | |
WaleedElmughrabi | 2:b14aac0ec647 | 114 | // Initialization |
WaleedElmughrabi | 2:b14aac0ec647 | 115 | status = BSP_SD_Init(); |
WaleedElmughrabi | 2:b14aac0ec647 | 116 | if (status == MSD_OK) { |
WaleedElmughrabi | 2:b14aac0ec647 | 117 | BSP_LCD_DisplayStringAt(0, LINE(5), (uint8_t *)"SD INIT OK", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 118 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 119 | else if (status == MSD_ERROR_SD_NOT_PRESENT) { |
WaleedElmughrabi | 2:b14aac0ec647 | 120 | BSP_LCD_DisplayStringAt(0, LINE(5), (uint8_t *)"SD CARD NOT FOUND", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 121 | print_FAIL(); |
bcostm | 0:eafcd0445e97 | 122 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 123 | else { |
WaleedElmughrabi | 2:b14aac0ec647 | 124 | BSP_LCD_DisplayStringAt(0, LINE(5), (uint8_t *)"SD INIT FAIL", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 125 | print_FAIL(); |
WaleedElmughrabi | 2:b14aac0ec647 | 126 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 127 | |
WaleedElmughrabi | 2:b14aac0ec647 | 128 | // Erase |
WaleedElmughrabi | 2:b14aac0ec647 | 129 | status = BSP_SD_Erase(BLOCK_START_ADDR, BLOCK_END_ADDR); |
WaleedElmughrabi | 2:b14aac0ec647 | 130 | if (status == MSD_OK) { |
WaleedElmughrabi | 2:b14aac0ec647 | 131 | BSP_LCD_DisplayStringAt(0, LINE(6), (uint8_t *)"SD ERASE OK", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 132 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 133 | else { |
WaleedElmughrabi | 2:b14aac0ec647 | 134 | BSP_LCD_DisplayStringAt(0, LINE(6), (uint8_t *)"SD ERASE FAIL", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 135 | print_FAIL(); |
bcostm | 0:eafcd0445e97 | 136 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 137 | |
WaleedElmughrabi | 2:b14aac0ec647 | 138 | // Prepare the buffer to write |
WaleedElmughrabi | 2:b14aac0ec647 | 139 | Fill_Buffer(aTxBuffer, BUFFER_WORDS_SIZE, 0x22FF); |
WaleedElmughrabi | 3:bc4495101c7b | 140 | |
WaleedElmughrabi | 2:b14aac0ec647 | 141 | // Write |
WaleedElmughrabi | 2:b14aac0ec647 | 142 | status = BSP_SD_WriteBlocks(aTxBuffer, BLOCK_START_ADDR, NUM_OF_BLOCKS, SD_DATATIMEOUT); |
WaleedElmughrabi | 2:b14aac0ec647 | 143 | if (status == MSD_OK) { |
WaleedElmughrabi | 2:b14aac0ec647 | 144 | BSP_LCD_DisplayStringAt(0, LINE(7), (uint8_t *)"SD WRITE OK", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 145 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 146 | else { |
WaleedElmughrabi | 2:b14aac0ec647 | 147 | BSP_LCD_DisplayStringAt(0, LINE(7), (uint8_t *)"SD WRITE FAIL", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 148 | print_FAIL(); |
WaleedElmughrabi | 2:b14aac0ec647 | 149 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 150 | |
WaleedElmughrabi | 2:b14aac0ec647 | 151 | // Read |
WaleedElmughrabi | 2:b14aac0ec647 | 152 | status = BSP_SD_ReadBlocks(aRxBuffer, BLOCK_START_ADDR, NUM_OF_BLOCKS, SD_DATATIMEOUT); |
WaleedElmughrabi | 2:b14aac0ec647 | 153 | if (status == MSD_OK) { |
WaleedElmughrabi | 2:b14aac0ec647 | 154 | BSP_LCD_DisplayStringAt(0, LINE(8), (uint8_t *)"SD READ OK", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 155 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 156 | else { |
WaleedElmughrabi | 2:b14aac0ec647 | 157 | BSP_LCD_DisplayStringAt(0, LINE(8), (uint8_t *)"SD READ FAIL", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 158 | print_FAIL(); |
WaleedElmughrabi | 2:b14aac0ec647 | 159 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 160 | |
WaleedElmughrabi | 2:b14aac0ec647 | 161 | // Compare data |
WaleedElmughrabi | 2:b14aac0ec647 | 162 | if (Buffercmp(aTxBuffer, aRxBuffer, BUFFER_WORDS_SIZE) == 0) { |
WaleedElmughrabi | 2:b14aac0ec647 | 163 | BSP_LCD_DisplayStringAt(0, LINE(9), (uint8_t *)"SD DATA OK", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 164 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 165 | else { |
WaleedElmughrabi | 2:b14aac0ec647 | 166 | BSP_LCD_DisplayStringAt(0, LINE(9), (uint8_t *)"SD DATA FAIL", LEFT_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 167 | print_FAIL(); |
bcostm | 0:eafcd0445e97 | 168 | } |
bcostm | 0:eafcd0445e97 | 169 | |
WaleedElmughrabi | 3:bc4495101c7b | 170 | int inpoly; |
WaleedElmughrabi | 3:bc4495101c7b | 171 | float x[5] = { 1,4,4,1,1}; |
WaleedElmughrabi | 3:bc4495101c7b | 172 | float y[5] = { 1,1,4,4,1}; |
WaleedElmughrabi | 3:bc4495101c7b | 173 | float xtest = 2; |
WaleedElmughrabi | 3:bc4495101c7b | 174 | float ytest = 2; |
WaleedElmughrabi | 2:b14aac0ec647 | 175 | |
WaleedElmughrabi | 3:bc4495101c7b | 176 | while(1){ |
WaleedElmughrabi | 3:bc4495101c7b | 177 | tempSerial = getTemp(t); |
WaleedElmughrabi | 3:bc4495101c7b | 178 | inpoly = pnpoly(5,x, y, xtest,ytest); |
WaleedElmughrabi | 3:bc4495101c7b | 179 | serial.printf("inpoly = %d\r\n", inpoly); |
WaleedElmughrabi | 2:b14aac0ec647 | 180 | wait(5); |
WaleedElmughrabi | 2:b14aac0ec647 | 181 | } |
bcostm | 0:eafcd0445e97 | 182 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 183 | |
WaleedElmughrabi | 2:b14aac0ec647 | 184 | static void print_demo_title(void) |
WaleedElmughrabi | 2:b14aac0ec647 | 185 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 186 | BSP_LCD_Init(); |
WaleedElmughrabi | 2:b14aac0ec647 | 187 | BSP_LCD_Clear(LCD_COLOR_WHITE); |
WaleedElmughrabi | 2:b14aac0ec647 | 188 | BSP_LCD_SetTextColor(LCD_COLOR_BLUE); |
WaleedElmughrabi | 2:b14aac0ec647 | 189 | BSP_LCD_FillRect(0, 0, BSP_LCD_GetXSize(), 80); |
WaleedElmughrabi | 2:b14aac0ec647 | 190 | BSP_LCD_SetTextColor(LCD_COLOR_WHITE); |
WaleedElmughrabi | 2:b14aac0ec647 | 191 | BSP_LCD_SetBackColor(LCD_COLOR_BLUE); |
WaleedElmughrabi | 2:b14aac0ec647 | 192 | BSP_LCD_SetFont(&Font24); |
WaleedElmughrabi | 2:b14aac0ec647 | 193 | BSP_LCD_DisplayStringAt(0, 0, (uint8_t *)"SDCARD", CENTER_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 194 | BSP_LCD_SetFont(&Font12); |
WaleedElmughrabi | 2:b14aac0ec647 | 195 | BSP_LCD_DisplayStringAt(0, 30, (uint8_t *)"This example shows how to write", CENTER_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 196 | BSP_LCD_DisplayStringAt(0, 45, (uint8_t *)"and read data on the SDCard", CENTER_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 197 | BSP_LCD_SetFont(&Font20); |
WaleedElmughrabi | 2:b14aac0ec647 | 198 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 199 | |
WaleedElmughrabi | 3:bc4495101c7b | 200 | //static void print_PASS(void) |
WaleedElmughrabi | 3:bc4495101c7b | 201 | //{ |
WaleedElmughrabi | 3:bc4495101c7b | 202 | // BSP_LCD_SetTextColor(LCD_COLOR_BLACK); |
WaleedElmughrabi | 3:bc4495101c7b | 203 | // BSP_LCD_SetBackColor(LCD_COLOR_GREEN); |
WaleedElmughrabi | 3:bc4495101c7b | 204 | // BSP_LCD_DisplayStringAt(0, LINE(11), (uint8_t *)"Demo OK", CENTER_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 205 | //while(1); |
WaleedElmughrabi | 3:bc4495101c7b | 206 | //} |
WaleedElmughrabi | 2:b14aac0ec647 | 207 | |
WaleedElmughrabi | 2:b14aac0ec647 | 208 | static void print_FAIL(void) |
WaleedElmughrabi | 2:b14aac0ec647 | 209 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 210 | BSP_LCD_SetBackColor(LCD_COLOR_RED); |
WaleedElmughrabi | 2:b14aac0ec647 | 211 | BSP_LCD_DisplayStringAt(0, LINE(11), (uint8_t *)"Demo FAILED", CENTER_MODE); |
WaleedElmughrabi | 2:b14aac0ec647 | 212 | // while(1); |
WaleedElmughrabi | 2:b14aac0ec647 | 213 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 214 | |
WaleedElmughrabi | 2:b14aac0ec647 | 215 | /** |
WaleedElmughrabi | 2:b14aac0ec647 | 216 | * @brief Fills buffer with user predefined data. |
WaleedElmughrabi | 2:b14aac0ec647 | 217 | * @param pBuffer: pointer on the buffer to fill |
WaleedElmughrabi | 2:b14aac0ec647 | 218 | * @param uwBufferLenght: size of the buffer to fill |
WaleedElmughrabi | 2:b14aac0ec647 | 219 | * @param uwOffset: first value to fill on the buffer |
WaleedElmughrabi | 2:b14aac0ec647 | 220 | * @retval None |
WaleedElmughrabi | 2:b14aac0ec647 | 221 | */ |
WaleedElmughrabi | 2:b14aac0ec647 | 222 | static void Fill_Buffer(uint32_t *pBuffer, uint32_t uwBufferLength, uint32_t uwOffset) |
WaleedElmughrabi | 2:b14aac0ec647 | 223 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 224 | uint32_t tmpIndex = 0; |
WaleedElmughrabi | 2:b14aac0ec647 | 225 | /* Put in global buffer different values */ |
WaleedElmughrabi | 2:b14aac0ec647 | 226 | for (tmpIndex = 0; tmpIndex < uwBufferLength; tmpIndex++ ) { |
WaleedElmughrabi | 2:b14aac0ec647 | 227 | pBuffer[tmpIndex] = tmpIndex + uwOffset; |
WaleedElmughrabi | 2:b14aac0ec647 | 228 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 229 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 230 | |
WaleedElmughrabi | 2:b14aac0ec647 | 231 | /** |
WaleedElmughrabi | 2:b14aac0ec647 | 232 | * @brief Compares two buffers. |
WaleedElmughrabi | 2:b14aac0ec647 | 233 | * @param pBuffer1, pBuffer2: buffers to be compared. |
WaleedElmughrabi | 2:b14aac0ec647 | 234 | * @param BufferLength: buffer's length |
WaleedElmughrabi | 2:b14aac0ec647 | 235 | * @retval 0: pBuffer2 identical to pBuffer1 |
WaleedElmughrabi | 2:b14aac0ec647 | 236 | * 1: pBuffer2 differs from pBuffer1 |
WaleedElmughrabi | 2:b14aac0ec647 | 237 | */ |
WaleedElmughrabi | 2:b14aac0ec647 | 238 | static uint8_t Buffercmp(uint32_t* pBuffer1, uint32_t* pBuffer2, uint16_t BufferLength) |
WaleedElmughrabi | 2:b14aac0ec647 | 239 | { |
WaleedElmughrabi | 2:b14aac0ec647 | 240 | while (BufferLength--) { |
WaleedElmughrabi | 2:b14aac0ec647 | 241 | if (*pBuffer1 != *pBuffer2) { |
WaleedElmughrabi | 2:b14aac0ec647 | 242 | return 1; |
WaleedElmughrabi | 2:b14aac0ec647 | 243 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 244 | pBuffer1++; |
WaleedElmughrabi | 2:b14aac0ec647 | 245 | pBuffer2++; |
WaleedElmughrabi | 2:b14aac0ec647 | 246 | } |
WaleedElmughrabi | 2:b14aac0ec647 | 247 | return 0; |
WaleedElmughrabi | 2:b14aac0ec647 | 248 | } |
WaleedElmughrabi | 3:bc4495101c7b | 249 | |
WaleedElmughrabi | 3:bc4495101c7b | 250 |