Jon Freeman / Mbed 2 deprecated Brute_TS_Controller_2018_11

Touch screen drivers control dashboard for miniature locomotive. Features meters for speed, volts, power. Switches for lights, horns. Drives multiple STM3_ESC brushless motor controllers for complete brushless loco system as used in "The Brute" - www.jons-workshop.com

Dependencies:   TS_DISCO_F746NG mbed Servo LCD_DISCO_F746NG BSP_DISCO_F746NG QSPI_DISCO_F746NG AsyncSerial FastPWM

qspi_mem.cpp@4:67478861c670, 2018-04-09 (annotated)

Committer:
JonFreeman
Date:
Mon Apr 09 07:51:37 2018 +0000
Revision:
4:67478861c670
Child:
5:21a8ac83142c
First edit of code from 2017 for new Twin BLDC controller boards

Who changed what in which revision?

UserRevisionLine numberNew contents of line
JonFreeman 4:67478861c670 1 #include "mbed.h"
JonFreeman 4:67478861c670 2 #include "Electric_Loco.h"
JonFreeman 4:67478861c670 3
JonFreeman 4:67478861c670 4 #ifdef QSPI // Defined in Electric_Loco.h
JonFreeman 4:67478861c670 5 #include "QSPI_DISCO_F746NG.h"
JonFreeman 4:67478861c670 6
JonFreeman 4:67478861c670 7 struct log_element {
JonFreeman 4:67478861c670 8 uint32_t pulsetot; // Total distance ever in pulse count
JonFreeman 4:67478861c670 9 uint16_t powerW; // during previous second
JonFreeman 4:67478861c670 10 uint16_t volts; // during previous second
JonFreeman 4:67478861c670 11 } ;
JonFreeman 4:67478861c670 12
JonFreeman 4:67478861c670 13 static const int START_BANK = 97; // Which 4k segment to start at
JonFreeman 4:67478861c670 14 static const int BANKS_4K = 4; // Numof 4k byte pages used to store recent records
JonFreeman 4:67478861c670 15
JonFreeman 4:67478861c670 16 QSPI_DISCO_F746NG qspi;
JonFreeman 4:67478861c670 17 extern Serial pc;
JonFreeman 4:67478861c670 18 extern uint32_t historic_distance;
JonFreeman 4:67478861c670 19
JonFreeman 4:67478861c670 20 QSPI_Info pQSPI_Info;
JonFreeman 4:67478861c670 21
JonFreeman 4:67478861c670 22 bool qspimemcheck () {
JonFreeman 4:67478861c670 23 qspi.GetInfo(&pQSPI_Info);
JonFreeman 4:67478861c670 24 if ((pQSPI_Info.FlashSize != N25Q128A_FLASH_SIZE) ||
JonFreeman 4:67478861c670 25 (pQSPI_Info.EraseSectorSize != N25Q128A_SUBSECTOR_SIZE) ||
JonFreeman 4:67478861c670 26 (pQSPI_Info.ProgPageSize != N25Q128A_PAGE_SIZE) ||
JonFreeman 4:67478861c670 27 (pQSPI_Info.EraseSectorsNumber != N25Q128A_SUBSECTOR_SIZE) ||
JonFreeman 4:67478861c670 28 (pQSPI_Info.ProgPagesNumber != N25Q128A_SECTOR_SIZE))
JonFreeman 4:67478861c670 29 {
JonFreeman 4:67478861c670 30 error("Get informations FAILED\r\n");
JonFreeman 4:67478861c670 31 return false;
JonFreeman 4:67478861c670 32 }
JonFreeman 4:67478861c670 33 else
JonFreeman 4:67478861c670 34 {
JonFreeman 4:67478861c670 35 pc.printf("Get informations PASSED\r\n");
JonFreeman 4:67478861c670 36 pc.printf ("FLASH_SIZE\t\t%d\r\n", N25Q128A_FLASH_SIZE);
JonFreeman 4:67478861c670 37 pc.printf ("ERASE_SECTOR_SIZE\t%d\r\n", N25Q128A_SUBSECTOR_SIZE);
JonFreeman 4:67478861c670 38 pc.printf ("PROG_PAGE_SIZE\t\t%d\r\n", N25Q128A_PAGE_SIZE);
JonFreeman 4:67478861c670 39 pc.printf ("Erase sectors number\t%d\r\n", N25Q128A_SUBSECTOR_SIZE);
JonFreeman 4:67478861c670 40 pc.printf ("N25Q128A_SECTOR_SIZE\t%d\r\n", N25Q128A_SECTOR_SIZE);
JonFreeman 4:67478861c670 41 return true;
JonFreeman 4:67478861c670 42 }
JonFreeman 4:67478861c670 43 }
JonFreeman 4:67478861c670 44
JonFreeman 4:67478861c670 45 int ask_QSPI_OK () {
JonFreeman 4:67478861c670 46 return QSPI_OK;
JonFreeman 4:67478861c670 47 }
JonFreeman 4:67478861c670 48
JonFreeman 4:67478861c670 49 int qspiinit () {
JonFreeman 4:67478861c670 50 int r = qspi.Init();
JonFreeman 4:67478861c670 51 if (r != QSPI_OK)
JonFreeman 4:67478861c670 52 pc.printf ("QSPI Init failed.\r\n");
JonFreeman 4:67478861c670 53 return r;
JonFreeman 4:67478861c670 54 }
JonFreeman 4:67478861c670 55
JonFreeman 4:67478861c670 56 void show_bank (uint32_t bank) {
JonFreeman 4:67478861c670 57 uint8_t bu[4096];
JonFreeman 4:67478861c670 58 struct log_element * p = (log_element *)bu;
JonFreeman 4:67478861c670 59 if (qspi.Read(bu, bank << 12, 4096) != QSPI_OK) {
JonFreeman 4:67478861c670 60 pc.printf ("Error reading qspi mem in show_bank\r\n");
JonFreeman 4:67478861c670 61 return ;
JonFreeman 4:67478861c670 62 }
JonFreeman 4:67478861c670 63 pc.printf ("Listing records in bank %d\r\n", bank);
JonFreeman 4:67478861c670 64 for (int i = 0; i < 4095 / sizeof(struct log_element); i++) {
JonFreeman 4:67478861c670 65 pc.printf ("p->pulsetot%ld, powerW %d, volts %d, addr %lx\r\n", p->pulsetot, p->powerW, p->volts, (uint32_t)p++);
JonFreeman 4:67478861c670 66 }
JonFreeman 4:67478861c670 67 }
JonFreeman 4:67478861c670 68
JonFreeman 4:67478861c670 69 void show_all_banks ();
JonFreeman 4:67478861c670 70 void show_all_banks () {
JonFreeman 4:67478861c670 71 for (int bank = START_BANK; bank < START_BANK + BANKS_4K; bank++)
JonFreeman 4:67478861c670 72 show_bank (bank);
JonFreeman 4:67478861c670 73 }
JonFreeman 4:67478861c670 74
JonFreeman 4:67478861c670 75 class distance_measurement {
JonFreeman 4:67478861c670 76
JonFreeman 4:67478861c670 77 uint32_t bank;
JonFreeman 4:67478861c670 78 uint32_t ptr;
JonFreeman 4:67478861c670 79 uint8_t buff[4096]; // Reqd qspi ram 4k at a time into here
JonFreeman 4:67478861c670 80
JonFreeman 4:67478861c670 81 bool test_element_free (uint8_t* p) ;
JonFreeman 4:67478861c670 82 bool test_bank_free (uint32_t addr) ;
JonFreeman 4:67478861c670 83 bool test_buff_free () ;
JonFreeman 4:67478861c670 84 public:
JonFreeman 4:67478861c670 85 bool zero () ;
JonFreeman 4:67478861c670 86 bool update (uint32_t pulsetot, uint16_t pow, uint16_t volt) ;
JonFreeman 4:67478861c670 87
JonFreeman 4:67478861c670 88 distance_measurement () { // Constructor
JonFreeman 4:67478861c670 89 uint32_t obank = 0, optr = 0, lptr = 0;
JonFreeman 4:67478861c670 90 bool free_elem_found = false;
JonFreeman 4:67478861c670 91 qspi.Init ();
JonFreeman 4:67478861c670 92
JonFreeman 4:67478861c670 93 bank = START_BANK;
JonFreeman 4:67478861c670 94 while (bank < START_BANK + BANKS_4K && !free_elem_found) {
JonFreeman 4:67478861c670 95 if (qspi.Read(buff, bank << 12, 4096) != QSPI_OK) {
JonFreeman 4:67478861c670 96 pc.printf ("Error reading qspi mem\r\n");
JonFreeman 4:67478861c670 97 }
JonFreeman 4:67478861c670 98 for (ptr = 0; !free_elem_found && ptr < 4096; ptr += sizeof(struct log_element)) {
JonFreeman 4:67478861c670 99 free_elem_found = test_element_free (&buff[ptr]);
JonFreeman 4:67478861c670 100 if (free_elem_found) {
JonFreeman 4:67478861c670 101 obank = bank;
JonFreeman 4:67478861c670 102 optr = ptr;
JonFreeman 4:67478861c670 103 pc.printf ("Found free element at bank %d, ptr %x\r\n", bank, ptr);
JonFreeman 4:67478861c670 104 }
JonFreeman 4:67478861c670 105 else { // Not free element found
JonFreeman 4:67478861c670 106 lptr = ptr;
JonFreeman 4:67478861c670 107 }
JonFreeman 4:67478861c670 108 }
JonFreeman 4:67478861c670 109 bank++;
JonFreeman 4:67478861c670 110 }
JonFreeman 4:67478861c670 111 bank = obank;
JonFreeman 4:67478861c670 112 ptr = optr;
JonFreeman 4:67478861c670 113 struct log_element * p = (log_element *)(buff + lptr);
JonFreeman 4:67478861c670 114 historic_distance = p->pulsetot;
JonFreeman 4:67478861c670 115 pc.printf ("Constructor found free elem at bank %d, position %d, previous total %ld, volts %.3f\r\n", bank, ptr, p->pulsetot, ((double)p->volts) / 500.0);
JonFreeman 4:67478861c670 116 } // endof constructor
JonFreeman 4:67478861c670 117 } odometer;
JonFreeman 4:67478861c670 118
JonFreeman 4:67478861c670 119
JonFreeman 4:67478861c670 120 bool distance_measurement::test_element_free (uint8_t* p) {
JonFreeman 4:67478861c670 121 for (int i = 0; i < sizeof(log_element); i++)
JonFreeman 4:67478861c670 122 if (*(p + i) != 0xff)
JonFreeman 4:67478861c670 123 return false;
JonFreeman 4:67478861c670 124 return true;
JonFreeman 4:67478861c670 125 }
JonFreeman 4:67478861c670 126
JonFreeman 4:67478861c670 127 bool distance_measurement::test_buff_free () {
JonFreeman 4:67478861c670 128 for (int i = 0; i < 4096; i++)
JonFreeman 4:67478861c670 129 if (buff[i] != 0xff)
JonFreeman 4:67478861c670 130 return false;
JonFreeman 4:67478861c670 131 return true;
JonFreeman 4:67478861c670 132 }
JonFreeman 4:67478861c670 133
JonFreeman 4:67478861c670 134 bool distance_measurement::test_bank_free (uint32_t addr) {
JonFreeman 4:67478861c670 135 if (qspi.Read (buff, addr & 0xfffff000, 4096) != QSPI_OK) {
JonFreeman 4:67478861c670 136 pc.printf ("Read error in test_bank_free\r\n");
JonFreeman 4:67478861c670 137 return false;
JonFreeman 4:67478861c670 138 }
JonFreeman 4:67478861c670 139 return test_buff_free ();
JonFreeman 4:67478861c670 140 }
JonFreeman 4:67478861c670 141
JonFreeman 4:67478861c670 142 bool distance_measurement::zero () {
JonFreeman 4:67478861c670 143 bool rv = true;
JonFreeman 4:67478861c670 144 for (int i = START_BANK; i < START_BANK + BANKS_4K; i++) {
JonFreeman 4:67478861c670 145 if (qspi.Erase_Block(i << 12) != QSPI_OK) {
JonFreeman 4:67478861c670 146 pc.printf ("Error zeroing odometer!\r\n");
JonFreeman 4:67478861c670 147 rv = false;
JonFreeman 4:67478861c670 148 }
JonFreeman 4:67478861c670 149 if (!test_bank_free (i << 12))
JonFreeman 4:67478861c670 150 pc.printf ("Bank [%d] not freed in zero\r\n", i);
JonFreeman 4:67478861c670 151 else
JonFreeman 4:67478861c670 152 pc.printf ("Cleared bank [%d] in zero\r\n", i);
JonFreeman 4:67478861c670 153 }
JonFreeman 4:67478861c670 154 bank = START_BANK;
JonFreeman 4:67478861c670 155 ptr = 0;
JonFreeman 4:67478861c670 156 return rv;
JonFreeman 4:67478861c670 157 }
JonFreeman 4:67478861c670 158
JonFreeman 4:67478861c670 159 bool distance_measurement::update (uint32_t pulsetot, uint16_t powr, uint16_t volt) {
JonFreeman 4:67478861c670 160 bool rv = true;
JonFreeman 4:67478861c670 161 struct log_element d;
JonFreeman 4:67478861c670 162 d.pulsetot = pulsetot;
JonFreeman 4:67478861c670 163 d.powerW = powr;
JonFreeman 4:67478861c670 164 d.volts = volt;
JonFreeman 4:67478861c670 165 uint32_t addr = ptr + (bank << 12);
JonFreeman 4:67478861c670 166 if (qspi.Write ((uint8_t*)&d, addr, sizeof(struct log_element)) != QSPI_OK) {
JonFreeman 4:67478861c670 167 pc.printf ("Write error in odometer update\r\n");
JonFreeman 4:67478861c670 168 qspi.Init(); // Attempt error recovery
JonFreeman 4:67478861c670 169 return false;
JonFreeman 4:67478861c670 170 }
JonFreeman 4:67478861c670 171 ptr += sizeof(struct log_element);
JonFreeman 4:67478861c670 172 if (ptr >= 4096) {
JonFreeman 4:67478861c670 173 ptr -= 4096;
JonFreeman 4:67478861c670 174 bank++;
JonFreeman 4:67478861c670 175 if (bank >= START_BANK + BANKS_4K)
JonFreeman 4:67478861c670 176 bank = START_BANK;
JonFreeman 4:67478861c670 177 //erase bank
JonFreeman 4:67478861c670 178 pc.printf ("About to erase bank %d\r\n", bank);
JonFreeman 4:67478861c670 179 if (qspi.Erase_Block(bank << 12) != QSPI_OK) {
JonFreeman 4:67478861c670 180 pc.printf ("Erase error in odometer update\r\n");
JonFreeman 4:67478861c670 181 rv = false;
JonFreeman 4:67478861c670 182 }
JonFreeman 4:67478861c670 183 }
JonFreeman 4:67478861c670 184 return rv;
JonFreeman 4:67478861c670 185 }
JonFreeman 4:67478861c670 186
JonFreeman 4:67478861c670 187 bool odometer_zero () ; // Returns true on success
JonFreeman 4:67478861c670 188 bool odometer_zero () { // Returns true on success
JonFreeman 4:67478861c670 189 return odometer.zero ();
JonFreeman 4:67478861c670 190 }
JonFreeman 4:67478861c670 191
JonFreeman 4:67478861c670 192 bool odometer_update (uint32_t pulsetot, uint16_t pow, uint16_t volt) ; // Hall pulse total updated once per sec and saved in blocks of 4096 bytes on QSPI onboard memory
JonFreeman 4:67478861c670 193 bool odometer_update (uint32_t pulsetot, uint16_t pow, uint16_t volt) { // Hall pulse total updated once per sec and saved in blocks of 4096 bytes on QSPI onboard memory
JonFreeman 4:67478861c670 194 return odometer.update (pulsetot, pow, volt);
JonFreeman 4:67478861c670 195 }
JonFreeman 4:67478861c670 196
JonFreeman 4:67478861c670 197 #endif