J L / Mbed 2 deprecated ringBuffer26

ringBuffer26

Dependencies:   mbed

readCommands.cpp@1:0cb065f9d55a, 2020-05-18 (annotated)

Committer:
Picmon
Date:
Mon May 18 19:04:41 2020 +0000
Revision:
1:0cb065f9d55a
ring buffer26;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Picmon 1:0cb065f9d55a 1 #include <stdio.h>
Picmon 1:0cb065f9d55a 2 #include "mbed.h"
Picmon 1:0cb065f9d55a 3 #include "main.h"
Picmon 1:0cb065f9d55a 4 #include "MotorControl.h"
Picmon 1:0cb065f9d55a 5 #include<string>
Picmon 1:0cb065f9d55a 6
Picmon 1:0cb065f9d55a 7
Picmon 1:0cb065f9d55a 8 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 9 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 10 // MOTOR COMMAND READ FUNCTIONS
Picmon 1:0cb065f9d55a 11 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 12 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 13
Picmon 1:0cb065f9d55a 14 void readDigInput(char *array){
Picmon 1:0cb065f9d55a 15 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 16 // Read digital inputs
Picmon 1:0cb065f9d55a 17 //
Picmon 1:0cb065f9d55a 18 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 19 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 20 sprintf(array,"READ DIGITAL INPUTS\r");
Picmon 1:0cb065f9d55a 21 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 22 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 23 rxMsgPending = true;
Picmon 1:0cb065f9d55a 24 led1=0;
Picmon 1:0cb065f9d55a 25
Picmon 1:0cb065f9d55a 26 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 27 cmdCnt++;
Picmon 1:0cb065f9d55a 28 else
Picmon 1:0cb065f9d55a 29 cmdCnt=0;
Picmon 1:0cb065f9d55a 30 }
Picmon 1:0cb065f9d55a 31 }
Picmon 1:0cb065f9d55a 32
Picmon 1:0cb065f9d55a 33 void readDigOutput(char *array){
Picmon 1:0cb065f9d55a 34 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 35 // Read digital inputs
Picmon 1:0cb065f9d55a 36 //
Picmon 1:0cb065f9d55a 37 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 38 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 39 sprintf(array,"READ DIGITAL OUTPUTS\r");
Picmon 1:0cb065f9d55a 40 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 41 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 42 rxMsgPending = true;
Picmon 1:0cb065f9d55a 43 led1=0;
Picmon 1:0cb065f9d55a 44
Picmon 1:0cb065f9d55a 45 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 46 cmdCnt++;
Picmon 1:0cb065f9d55a 47 else
Picmon 1:0cb065f9d55a 48 cmdCnt=0;
Picmon 1:0cb065f9d55a 49 }
Picmon 1:0cb065f9d55a 50 }
Picmon 1:0cb065f9d55a 51
Picmon 1:0cb065f9d55a 52 void readCurrent(char *array){
Picmon 1:0cb065f9d55a 53 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 54 // Read the motor current command
Picmon 1:0cb065f9d55a 55 //
Picmon 1:0cb065f9d55a 56 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 57 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 58 sprintf(array,"READ CURRENT ACTUAL\r");
Picmon 1:0cb065f9d55a 59 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 60 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 61 rxMsgPending = true;
Picmon 1:0cb065f9d55a 62 led1=0;
Picmon 1:0cb065f9d55a 63
Picmon 1:0cb065f9d55a 64 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 65 cmdCnt++;
Picmon 1:0cb065f9d55a 66 else
Picmon 1:0cb065f9d55a 67 cmdCnt=0;
Picmon 1:0cb065f9d55a 68 }
Picmon 1:0cb065f9d55a 69 }
Picmon 1:0cb065f9d55a 70
Picmon 1:0cb065f9d55a 71 void readDrvReg(char *array){
Picmon 1:0cb065f9d55a 72 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 73 // Read drive register command
Picmon 1:0cb065f9d55a 74 //
Picmon 1:0cb065f9d55a 75 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 76 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 77 sprintf(array,"READ DRIVE REGISTER\r");
Picmon 1:0cb065f9d55a 78 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 79 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 80 rxMsgPending = true;
Picmon 1:0cb065f9d55a 81 led1=0;
Picmon 1:0cb065f9d55a 82
Picmon 1:0cb065f9d55a 83 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 84 cmdCnt++;
Picmon 1:0cb065f9d55a 85 else
Picmon 1:0cb065f9d55a 86 cmdCnt=0;
Picmon 1:0cb065f9d55a 87 }
Picmon 1:0cb065f9d55a 88 }
Picmon 1:0cb065f9d55a 89
Picmon 1:0cb065f9d55a 90 void readDrvRegExt(char *array){
Picmon 1:0cb065f9d55a 91 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 92 // Read drive register extended command
Picmon 1:0cb065f9d55a 93 //
Picmon 1:0cb065f9d55a 94 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 95 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 96 sprintf(array,"READ DRIVE REGISTER EXTENDED\r");
Picmon 1:0cb065f9d55a 97 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 98 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 99 rxMsgPending = true;
Picmon 1:0cb065f9d55a 100 led1=0;
Picmon 1:0cb065f9d55a 101
Picmon 1:0cb065f9d55a 102 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 103 cmdCnt++;
Picmon 1:0cb065f9d55a 104 else
Picmon 1:0cb065f9d55a 105 cmdCnt=0;
Picmon 1:0cb065f9d55a 106 }
Picmon 1:0cb065f9d55a 107 }
Picmon 1:0cb065f9d55a 108
Picmon 1:0cb065f9d55a 109 void readTemp(char *array){
Picmon 1:0cb065f9d55a 110 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 111 // Read motor temperature command
Picmon 1:0cb065f9d55a 112 //
Picmon 1:0cb065f9d55a 113 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 114 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 115 sprintf(array,"READ DRIVE TEMPERATURE\r");
Picmon 1:0cb065f9d55a 116 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 117 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 118 rxMsgPending = true;
Picmon 1:0cb065f9d55a 119 led1=0;
Picmon 1:0cb065f9d55a 120
Picmon 1:0cb065f9d55a 121 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 122 cmdCnt++;
Picmon 1:0cb065f9d55a 123 else
Picmon 1:0cb065f9d55a 124 cmdCnt=0;
Picmon 1:0cb065f9d55a 125 }
Picmon 1:0cb065f9d55a 126 }
Picmon 1:0cb065f9d55a 127
Picmon 1:0cb065f9d55a 128 void readVoltage(char *array){
Picmon 1:0cb065f9d55a 129 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 130 // Read motor voltage command
Picmon 1:0cb065f9d55a 131 //
Picmon 1:0cb065f9d55a 132 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 133 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 134 sprintf(array,"READ DRIVE VOLTAGE\r");
Picmon 1:0cb065f9d55a 135 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 136 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 137 rxMsgPending = true;
Picmon 1:0cb065f9d55a 138 led1=0;
Picmon 1:0cb065f9d55a 139
Picmon 1:0cb065f9d55a 140 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 141 cmdCnt++;
Picmon 1:0cb065f9d55a 142 else
Picmon 1:0cb065f9d55a 143 cmdCnt=0;
Picmon 1:0cb065f9d55a 144 }
Picmon 1:0cb065f9d55a 145 }
Picmon 1:0cb065f9d55a 146
Picmon 1:0cb065f9d55a 147 void readDrvWorkSet(char *array){
Picmon 1:0cb065f9d55a 148 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 149 // Read drive working settings command
Picmon 1:0cb065f9d55a 150 //
Picmon 1:0cb065f9d55a 151 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 152 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 153 sprintf(array,"READ DRIVE WORKING SETTINGS\r");//<CR>
Picmon 1:0cb065f9d55a 154 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 155 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 156 rxMsgPending = true;
Picmon 1:0cb065f9d55a 157 led1=0;
Picmon 1:0cb065f9d55a 158
Picmon 1:0cb065f9d55a 159 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 160 cmdCnt++;
Picmon 1:0cb065f9d55a 161 else
Picmon 1:0cb065f9d55a 162 cmdCnt=0;
Picmon 1:0cb065f9d55a 163 }
Picmon 1:0cb065f9d55a 164 }
Picmon 1:0cb065f9d55a 165
Picmon 1:0cb065f9d55a 166 void readDrvWorkSetExt(char *array){
Picmon 1:0cb065f9d55a 167 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 168 // Read
Picmon 1:0cb065f9d55a 169 //
Picmon 1:0cb065f9d55a 170 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 171 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 172 sprintf(array,"READ DRIVE WORKING SETTINGS EXTENDED\r");//<CR>
Picmon 1:0cb065f9d55a 173 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 174 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 175 rxMsgPending = true;
Picmon 1:0cb065f9d55a 176 led1=0;
Picmon 1:0cb065f9d55a 177
Picmon 1:0cb065f9d55a 178 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 179 cmdCnt++;
Picmon 1:0cb065f9d55a 180 else
Picmon 1:0cb065f9d55a 181 cmdCnt=0;
Picmon 1:0cb065f9d55a 182 }
Picmon 1:0cb065f9d55a 183 }
Picmon 1:0cb065f9d55a 184
Picmon 1:0cb065f9d55a 185 void readErrReg(char *array){
Picmon 1:0cb065f9d55a 186 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 187 // Read error register command
Picmon 1:0cb065f9d55a 188 //
Picmon 1:0cb065f9d55a 189 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 190 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 191 sprintf(array,"READ ERROR REGISTER\r");
Picmon 1:0cb065f9d55a 192 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 193 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 194 rxMsgPending = true;
Picmon 1:0cb065f9d55a 195 led1=0;
Picmon 1:0cb065f9d55a 196
Picmon 1:0cb065f9d55a 197 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 198 cmdCnt++;
Picmon 1:0cb065f9d55a 199 else
Picmon 1:0cb065f9d55a 200 cmdCnt=0;
Picmon 1:0cb065f9d55a 201 }
Picmon 1:0cb065f9d55a 202 }
Picmon 1:0cb065f9d55a 203
Picmon 1:0cb065f9d55a 204 void readFBboostCur(char *array){
Picmon 1:0cb065f9d55a 205 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 206 // Read
Picmon 1:0cb065f9d55a 207 //
Picmon 1:0cb065f9d55a 208 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 209 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 210 sprintf(array,"READ FEEDBACK BOOST CURRENT\r");//<CR>
Picmon 1:0cb065f9d55a 211 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 212 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 213 rxMsgPending = true;
Picmon 1:0cb065f9d55a 214 led1=0;
Picmon 1:0cb065f9d55a 215
Picmon 1:0cb065f9d55a 216 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 217 cmdCnt++;
Picmon 1:0cb065f9d55a 218 else
Picmon 1:0cb065f9d55a 219 cmdCnt=0;
Picmon 1:0cb065f9d55a 220 }
Picmon 1:0cb065f9d55a 221 }
Picmon 1:0cb065f9d55a 222
Picmon 1:0cb065f9d55a 223 void readFBstat(char *array){
Picmon 1:0cb065f9d55a 224 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 225 // Read
Picmon 1:0cb065f9d55a 226 //
Picmon 1:0cb065f9d55a 227 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 228 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 229 sprintf(array,"READ FEEDBACK STATUS\r");//<CR>
Picmon 1:0cb065f9d55a 230 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 231 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 232 rxMsgPending = true;
Picmon 1:0cb065f9d55a 233 led1=0;
Picmon 1:0cb065f9d55a 234
Picmon 1:0cb065f9d55a 235 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 236 cmdCnt++;
Picmon 1:0cb065f9d55a 237 else
Picmon 1:0cb065f9d55a 238 cmdCnt=0;
Picmon 1:0cb065f9d55a 239 }
Picmon 1:0cb065f9d55a 240 }
Picmon 1:0cb065f9d55a 241
Picmon 1:0cb065f9d55a 242 void readFWVwersion(char *array){
Picmon 1:0cb065f9d55a 243 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 244 // Read the firmware version command
Picmon 1:0cb065f9d55a 245 //
Picmon 1:0cb065f9d55a 246 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 247 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 248 sprintf(array,"READ FIRMWARE VERSION\r");
Picmon 1:0cb065f9d55a 249 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 250 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 251 rxMsgPending = true;
Picmon 1:0cb065f9d55a 252 led1=0;
Picmon 1:0cb065f9d55a 253
Picmon 1:0cb065f9d55a 254 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 255 cmdCnt++;
Picmon 1:0cb065f9d55a 256 else
Picmon 1:0cb065f9d55a 257 cmdCnt=0;
Picmon 1:0cb065f9d55a 258 }
Picmon 1:0cb065f9d55a 259
Picmon 1:0cb065f9d55a 260 }
Picmon 1:0cb065f9d55a 261
Picmon 1:0cb065f9d55a 262 void readFWChecksum(char *array){
Picmon 1:0cb065f9d55a 263 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 264 // Read the firmware checksum command
Picmon 1:0cb065f9d55a 265 //
Picmon 1:0cb065f9d55a 266 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 267 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 268 sprintf(array,"READ FIRMWARE CHECKSUM\r");
Picmon 1:0cb065f9d55a 269 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 270 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 271 rxMsgPending = true;
Picmon 1:0cb065f9d55a 272 led1=0;
Picmon 1:0cb065f9d55a 273
Picmon 1:0cb065f9d55a 274 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 275 cmdCnt++;
Picmon 1:0cb065f9d55a 276 else
Picmon 1:0cb065f9d55a 277 cmdCnt=0;
Picmon 1:0cb065f9d55a 278 }
Picmon 1:0cb065f9d55a 279 }
Picmon 1:0cb065f9d55a 280
Picmon 1:0cb065f9d55a 281 void readMastReg(char *array){
Picmon 1:0cb065f9d55a 282 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 283 // Read
Picmon 1:0cb065f9d55a 284 //
Picmon 1:0cb065f9d55a 285 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 286 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 287 sprintf(array,"READ MASTER REGISTER\r");//<CR>
Picmon 1:0cb065f9d55a 288 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 289 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 290 rxMsgPending = true;
Picmon 1:0cb065f9d55a 291 led1=0;
Picmon 1:0cb065f9d55a 292
Picmon 1:0cb065f9d55a 293 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 294 cmdCnt++;
Picmon 1:0cb065f9d55a 295 else
Picmon 1:0cb065f9d55a 296 cmdCnt=0;
Picmon 1:0cb065f9d55a 297 }
Picmon 1:0cb065f9d55a 298 }
Picmon 1:0cb065f9d55a 299
Picmon 1:0cb065f9d55a 300 void readMinCur(char *array){
Picmon 1:0cb065f9d55a 301 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 302 // Read
Picmon 1:0cb065f9d55a 303 //
Picmon 1:0cb065f9d55a 304 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 305 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 306 sprintf(array,"READ MIN CURRENT\r");//<CR>
Picmon 1:0cb065f9d55a 307 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 308 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 309 rxMsgPending = true;
Picmon 1:0cb065f9d55a 310 led1=0;
Picmon 1:0cb065f9d55a 311
Picmon 1:0cb065f9d55a 312 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 313 cmdCnt++;
Picmon 1:0cb065f9d55a 314 else
Picmon 1:0cb065f9d55a 315 cmdCnt=0;
Picmon 1:0cb065f9d55a 316 }
Picmon 1:0cb065f9d55a 317 }
Picmon 1:0cb065f9d55a 318
Picmon 1:0cb065f9d55a 319 void readMaxCur(char *array){
Picmon 1:0cb065f9d55a 320 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 321 // Read
Picmon 1:0cb065f9d55a 322 //
Picmon 1:0cb065f9d55a 323 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 324 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 325 sprintf(array,"READ MAX CURRENT\r");//<CR>
Picmon 1:0cb065f9d55a 326 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 327 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 328 rxMsgPending = true;
Picmon 1:0cb065f9d55a 329 led1=0;
Picmon 1:0cb065f9d55a 330
Picmon 1:0cb065f9d55a 331 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 332 cmdCnt++;
Picmon 1:0cb065f9d55a 333 else
Picmon 1:0cb065f9d55a 334 cmdCnt=0;
Picmon 1:0cb065f9d55a 335 }
Picmon 1:0cb065f9d55a 336 }
Picmon 1:0cb065f9d55a 337
Picmon 1:0cb065f9d55a 338 void readBoostCur(char *array){
Picmon 1:0cb065f9d55a 339 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 340 // Read
Picmon 1:0cb065f9d55a 341 //
Picmon 1:0cb065f9d55a 342 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 343 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 344 sprintf(array,"READ BOOST CURRENT\r");//<CR>
Picmon 1:0cb065f9d55a 345 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 346 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 347 rxMsgPending = true;
Picmon 1:0cb065f9d55a 348 led1=0;
Picmon 1:0cb065f9d55a 349
Picmon 1:0cb065f9d55a 350 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 351 cmdCnt++;
Picmon 1:0cb065f9d55a 352 else
Picmon 1:0cb065f9d55a 353 cmdCnt=0;
Picmon 1:0cb065f9d55a 354 }
Picmon 1:0cb065f9d55a 355 }
Picmon 1:0cb065f9d55a 356
Picmon 1:0cb065f9d55a 357 void readNomCur(char *array){
Picmon 1:0cb065f9d55a 358 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 359 // Read
Picmon 1:0cb065f9d55a 360 //
Picmon 1:0cb065f9d55a 361 ////////////////////////////////////////////////////////////////////////////////
Picmon 1:0cb065f9d55a 362 if(rxMsgPending == false){
Picmon 1:0cb065f9d55a 363 sprintf(array,"READ NOMINAL CURRENT\r");//<CR>
Picmon 1:0cb065f9d55a 364 mc_debug.printf("%s",array);
Picmon 1:0cb065f9d55a 365 //mc_usart.printf("%s",array);
Picmon 1:0cb065f9d55a 366 rxMsgPending = true;
Picmon 1:0cb065f9d55a 367 led1=0;
Picmon 1:0cb065f9d55a 368
Picmon 1:0cb065f9d55a 369 if(cmdCnt < COMMANDS_TO_TEST)
Picmon 1:0cb065f9d55a 370 cmdCnt++;
Picmon 1:0cb065f9d55a 371 else
Picmon 1:0cb065f9d55a 372 cmdCnt=0;
Picmon 1:0cb065f9d55a 373 }
Picmon 1:0cb065f9d55a 374 }