From e3111cfe73b5cf4449df3e9edda987e2145e4601 Mon Sep 17 00:00:00 2001 From: GabrielKoppenstein Date: Fri, 27 Aug 2021 20:12:45 +0200 Subject: [PATCH] Function Matrix & Output Set function --- CV.h | 519 ++++++++++++++++++++++++++-------------------------- multicore.c | 28 +-- 2 files changed, 278 insertions(+), 269 deletions(-) diff --git a/CV.h b/CV.h index 77db323..5917cdf 100644 --- a/CV.h +++ b/CV.h @@ -1,333 +1,336 @@ #define CV_1 5 //Address - Basic Address #define CV_2 0 //V_min - Minimum Speed -#define CV_3 5 //Beschleunigungsrate - Definiert die Länge der Wartezeit, die beim Beschleunigen jeweils vor dem Hochschalten zur nächst höheren Fahrstufe vergeht. -#define CV_4 5 //Bremsrate - Definiert die Länge der Wartezeit, die beim Bremsen jeweils vor dem Herunterschalten zur nächst niedrigen Fahrstufe vergeht. +#define CV_3 5 //Accelaration Rate - Acceleration formula: (CV_3*0.896)/(number of speed steps in use) +#define CV_4 5 //Deceleration Rate - Deceleration formula: (CV_4*0.896)/(number of speed steps in use) #define CV_5 255 //V_max - Maximum Speed #define CV_6 127 //V_mid - Middle Speed #define CV_7 13 //Version No. - Decoder-Software version #define CV_8 13 //Manufacturer - Manufacturer Identification (13 == "Public Domain & Do-It-Yourself Decoders"). #define CV_9 5 //PWM-Period - Defines the Motor PWM-Period const uint8_t CV_FUNCTION_ARRAY [256] = { +// 31 30 29 28 - 27 26 25 24 -- 23 22 21 20 - 19 18 17 16 -- 15 14 13 12 - 11 10 9 8 -- 7 6 5 4 - 3 2 1 0 <- GPIO +// byte_3 -- byte_2 -- byte_1 -- byte_0 +// X X X X - X X X X -- X X X X - X X X X -- X X X X - X X X X -- X X X X - X X X X //F0 forward - 0b11111111, //byte 0 - CV_257 - 0b11111111, //byte 1 - CV_258 - 0b11111111, //byte 2 - CV_259 - 0b11111111, //byte 3 - CV_260 + 0b00000001, //byte 0 - CV_257 - Array Index: 0 + 0b00000000, //byte 1 - CV_258 - Array Index: 1 + 0b00000000, //byte 2 - CV_259 - Array Index: 2 + 0b01000000, //byte 3 - CV_260 - Array Index: 3 //F0 reverse - 0b11111111, //byte 0 - CV_261 - 0b11111111, //byte 1 - CV_262 - 0b11111111, //byte 2 - CV_263 - 0b11111111, //byte 3 - CV_264 + 0b00000000, //byte 0 - CV_261 - Array Index: 4 + 0b00000000, //byte 1 - CV_262 - Array Index: 5 + 0b00000000, //byte 2 - CV_263 - Array Index: 6 + 0b00000000, //byte 3 - CV_264 - Array Index: 7 //F1 forward - 0b11111111, //byte 0 - CV_265 - 0b11111111, //byte 1 - CV_266 - 0b11111111, //byte 2 - CV_267 - 0b11111111, //byte 3 - CV_268 + 0b00000000, //byte 0 - CV_265 - Array Index: 8 + 0b00000000, //byte 1 - CV_266 - Array Index: 9 + 0b00000000, //byte 2 - CV_267 - Array Index: 10 + 0b00000000, //byte 3 - CV_268 - Array Index: 11 //F1 reverse - 0b11111111, //byte 0 - CV_269 - 0b11111111, //byte 1 - CV_270 - 0b11111111, //byte 2 - CV_271 - 0b11111111, //byte 3 - CV_272 + 0b00000000, //byte 0 - CV_269 - Array Index: 12 + 0b00000000, //byte 1 - CV_270 - Array Index: 13 + 0b00000000, //byte 2 - CV_271 - Array Index: 14 + 0b00000000, //byte 3 - CV_272 - Array Index: 15 //F2 forward - 0b11111111, //byte 0 - CV_273 - 0b11111111, //byte 1 - CV_274 - 0b11111111, //byte 2 - CV_275 - 0b11111111, //byte 3 - CV_276 + 0b00000000, //byte 0 - CV_273 - Array Index: 16 + 0b00000000, //byte 1 - CV_274 - Array Index: 17 + 0b00000000, //byte 2 - CV_275 - Array Index: 18 + 0b00000000, //byte 3 - CV_276 - Array Index: 19 //F2 reverse - 0b11111111, //byte 0 - CV_277 - 0b11111111, //byte 1 - CV_278 - 0b11111111, //byte 2 - CV_279 - 0b11111111, //byte 3 - CV_280 + 0b00000000, //byte 0 - CV_277 - Array Index: 20 + 0b00000000, //byte 1 - CV_278 - Array Index: 21 + 0b00000000, //byte 2 - CV_279 - Array Index: 22 + 0b00000000, //byte 3 - CV_280 - Array Index: 23 //F3 forward - 0b11111111, //byte 0 - CV_281 - 0b11111111, //byte 1 - CV_282 - 0b11111111, //byte 2 - CV_283 - 0b11111111, //byte 3 - CV_284 + 0b00000000, //byte 0 - CV_281 - Array Index: 24 + 0b00000000, //byte 1 - CV_282 - Array Index: 25 + 0b00000000, //byte 2 - CV_283 - Array Index: 26 + 0b00000000, //byte 3 - CV_284 - Array Index: 27 //F3 reverse - 0b11111111, //byte 0 - CV_285 - 0b11111111, //byte 1 - CV_286 - 0b11111111, //byte 2 - CV_287 - 0b11111111, //byte 3 - CV_288 + 0b00000000, //byte 0 - CV_285 - Array Index: 28 + 0b00000000, //byte 1 - CV_286 - Array Index: 29 + 0b00000000, //byte 2 - CV_287 - Array Index: 30 + 0b00000000, //byte 3 - CV_288 - Array Index: 31 //F4 forward - 0b11111111, //byte 0 - CV_289 - 0b11111111, //byte 1 - CV_290 - 0b11111111, //byte 2 - CV_291 - 0b11111111, //byte 3 - CV_292 + 0b00000000, //byte 0 - CV_289 - Array Index: 32 + 0b00000000, //byte 1 - CV_290 - Array Index: 33 + 0b00000000, //byte 2 - CV_291 - Array Index: 34 + 0b00000000, //byte 3 - CV_292 - Array Index: 35 //F4 reverse - 0b11111111, //byte 0 - CV_293 - 0b11111111, //byte 1 - CV_294 - 0b11111111, //byte 2 - CV_295 - 0b11111111, //byte 3 - CV_296 + 0b00000000, //byte 0 - CV_293 - Array Index: 36 + 0b00000000, //byte 1 - CV_294 - Array Index: 37 + 0b00000000, //byte 2 - CV_295 - Array Index: 38 + 0b00000000, //byte 3 - CV_296 - Array Index: 39 //F5 forward - 0b11111111, //byte 0 - CV_297 - 0b11111111, //byte 1 - CV_298 - 0b11111111, //byte 2 - CV_299 - 0b11111111, //byte 3 - CV_300 + 0b00000000, //byte 0 - CV_297 - Array Index: 40 + 0b00000000, //byte 1 - CV_298 - Array Index: 41 + 0b00000000, //byte 2 - CV_299 - Array Index: 42 + 0b00000000, //byte 3 - CV_300 - Array Index: 43 //F5 reverse - 0b11111111, //byte 0 - CV_301 - 0b11111111, //byte 1 - CV_302 - 0b11111111, //byte 2 - CV_303 - 0b11111111, //byte 3 - CV_304 + 0b00000000, //byte 0 - CV_301 - Array Index: 44 + 0b00000000, //byte 1 - CV_302 - Array Index: 45 + 0b00000000, //byte 2 - CV_303 - Array Index: 46 + 0b00000000, //byte 3 - CV_304 - Array Index: 47 //F6 forward - 0b11111111, //byte 0 - CV_305 - 0b11111111, //byte 1 - CV_306 - 0b11111111, //byte 2 - CV_307 - 0b11111111, //byte 3 - CV_308 + 0b00000000, //byte 0 - CV_305 - Array Index: 48 + 0b00000000, //byte 1 - CV_306 - Array Index: 49 + 0b00000000, //byte 2 - CV_307 - Array Index: 50 + 0b00000000, //byte 3 - CV_308 - Array Index: 51 //F6 reverse - 0b11111111, //byte 0 - CV_309 - 0b11111111, //byte 1 - CV_310 - 0b11111111, //byte 2 - CV_311 - 0b11111111, //byte 3 - CV_312 + 0b00000000, //byte 0 - CV_309 - Array Index: 52 + 0b00000000, //byte 1 - CV_310 - Array Index: 53 + 0b00000000, //byte 2 - CV_311 - Array Index: 54 + 0b00000000, //byte 3 - CV_312 - Array Index: 55 //F7 forward - 0b11111111, //byte 0 - CV_313 - 0b11111111, //byte 1 - CV_314 - 0b11111111, //byte 2 - CV_315 - 0b11111111, //byte 3 - CV_316 + 0b00000000, //byte 0 - CV_313 - Array Index: 56 + 0b00000000, //byte 1 - CV_314 - Array Index: 57 + 0b00000000, //byte 2 - CV_315 - Array Index: 58 + 0b00000000, //byte 3 - CV_316 - Array Index: 59 //F7 reverse - 0b11111111, //byte 0 - CV_317 - 0b11111111, //byte 1 - CV_318 - 0b11111111, //byte 2 - CV_319 - 0b11111111, //byte 3 - CV_320 + 0b00000000, //byte 0 - CV_317 - Array Index: 60 + 0b00000000, //byte 1 - CV_318 - Array Index: 61 + 0b00000000, //byte 2 - CV_319 - Array Index: 62 + 0b00000000, //byte 3 - CV_320 - Array Index: 63 //F8 forward - 0b11111111, //byte 0 - CV_321 - 0b11111111, //byte 1 - CV_322 - 0b11111111, //byte 2 - CV_323 - 0b11111111, //byte 3 - CV_324 + 0b00000000, //byte 0 - CV_321 - Array Index: 64 + 0b00000000, //byte 1 - CV_322 - Array Index: 65 + 0b00000000, //byte 2 - CV_323 - Array Index: 66 + 0b00000000, //byte 3 - CV_324 - Array Index: 67 //F8 reverse - 0b11111111, //byte 0 - CV_325 - 0b11111111, //byte 1 - CV_326 - 0b11111111, //byte 2 - CV_327 - 0b11111111, //byte 3 - CV_328 + 0b00000000, //byte 0 - CV_325 - Array Index: 68 + 0b00000000, //byte 1 - CV_326 - Array Index: 69 + 0b00000000, //byte 2 - CV_327 - Array Index: 70 + 0b00000000, //byte 3 - CV_328 - Array Index: 71 //F9 forward - 0b11111111, //byte 0 - CV_329 - 0b11111111, //byte 1 - CV_330 - 0b11111111, //byte 2 - CV_331 - 0b11111111, //byte 3 - CV_332 + 0b00000000, //byte 0 - CV_329 - Array Index: 72 + 0b00000000, //byte 1 - CV_330 - Array Index: 73 + 0b00000000, //byte 2 - CV_331 - Array Index: 74 + 0b00000000, //byte 3 - CV_332 - Array Index: 75 //F9 reverse - 0b11111111, //byte 0 - CV_333 - 0b11111111, //byte 1 - CV_334 - 0b11111111, //byte 2 - CV_335 - 0b11111111, //byte 3 - CV_336 + 0b00000000, //byte 0 - CV_333 - Array Index: 76 + 0b00000000, //byte 1 - CV_334 - Array Index: 77 + 0b00000000, //byte 2 - CV_335 - Array Index: 78 + 0b00000000, //byte 3 - CV_336 - Array Index: 79 //F10 forward - 0b11111111, //byte 0 - CV_337 - 0b11111111, //byte 1 - CV_338 - 0b11111111, //byte 2 - CV_339 - 0b11111111, //byte 3 - CV_340 + 0b00000000, //byte 0 - CV_337 - Array Index: 80 + 0b00000000, //byte 1 - CV_338 - Array Index: 81 + 0b00000000, //byte 2 - CV_339 - Array Index: 82 + 0b00000000, //byte 3 - CV_340 - Array Index: 83 //F10 reverse - 0b11111111, //byte 0 - CV_341 - 0b11111111, //byte 1 - CV_342 - 0b11111111, //byte 2 - CV_343 - 0b11111111, //byte 3 - CV_344 + 0b00000000, //byte 0 - CV_341 - Array Index: 84 + 0b00000000, //byte 1 - CV_342 - Array Index: 85 + 0b00000000, //byte 2 - CV_343 - Array Index: 86 + 0b00000000, //byte 3 - CV_344 - Array Index: 87 //F11 forward - 0b11111111, //byte 0 - CV_345 - 0b11111111, //byte 1 - CV_346 - 0b11111111, //byte 2 - CV_347 - 0b11111111, //byte 3 - CV_348 + 0b00000000, //byte 0 - CV_345 - Array Index: 88 + 0b00000000, //byte 1 - CV_346 - Array Index: 89 + 0b00000000, //byte 2 - CV_347 - Array Index: 90 + 0b00000000, //byte 3 - CV_348 - Array Index: 91 //F11 reverse - 0b11111111, //byte 0 - CV_349 - 0b11111111, //byte 1 - CV_350 - 0b11111111, //byte 2 - CV_351 - 0b11111111, //byte 3 - CV_352 + 0b00000000, //byte 0 - CV_349 - Array Index: 92 + 0b00000000, //byte 1 - CV_350 - Array Index: 93 + 0b00000000, //byte 2 - CV_351 - Array Index: 94 + 0b00000000, //byte 3 - CV_352 - Array Index: 95 //F12 forward - 0b11111111, //byte 0 - CV_353 - 0b11111111, //byte 1 - CV_354 - 0b11111111, //byte 2 - CV_355 - 0b11111111, //byte 3 - CV_356 + 0b00000000, //byte 0 - CV_353 - Array Index: 96 + 0b00000000, //byte 1 - CV_354 - Array Index: 97 + 0b00000000, //byte 2 - CV_355 - Array Index: 98 + 0b00000000, //byte 3 - CV_356 - Array Index: 99 //F12 reverse - 0b11111111, //byte 0 - CV_357 - 0b11111111, //byte 1 - CV_358 - 0b11111111, //byte 2 - CV_359 - 0b11111111, //byte 3 - CV_360 + 0b00000000, //byte 0 - CV_357 - Array Index: 100 + 0b00000000, //byte 1 - CV_358 - Array Index: 101 + 0b00000000, //byte 2 - CV_359 - Array Index: 102 + 0b00000000, //byte 3 - CV_360 - Array Index: 103 //F13 forward - 0b11111111, //byte 0 - CV_361 - 0b11111111, //byte 1 - CV_362 - 0b11111111, //byte 2 - CV_363 - 0b11111111, //byte 3 - CV_364 + 0b00000000, //byte 0 - CV_361 - Array Index: 104 + 0b00000000, //byte 1 - CV_362 - Array Index: 105 + 0b00000000, //byte 2 - CV_363 - Array Index: 106 + 0b00000000, //byte 3 - CV_364 - Array Index: 107 //F13 reverse - 0b11111111, //byte 0 - CV_365 - 0b11111111, //byte 1 - CV_366 - 0b11111111, //byte 2 - CV_367 - 0b11111111, //byte 3 - CV_368 + 0b00000000, //byte 0 - CV_365 - Array Index: 108 + 0b00000000, //byte 1 - CV_366 - Array Index: 109 + 0b00000000, //byte 2 - CV_367 - Array Index: 110 + 0b00000000, //byte 3 - CV_368 - Array Index: 111 //F14 forward - 0b11111111, //byte 0 - CV_369 - 0b11111111, //byte 1 - CV_370 - 0b11111111, //byte 2 - CV_371 - 0b11111111, //byte 3 - CV_372 + 0b00000000, //byte 0 - CV_369 - Array Index: 112 + 0b00000000, //byte 1 - CV_370 - Array Index: 113 + 0b00000000, //byte 2 - CV_371 - Array Index: 114 + 0b00000000, //byte 3 - CV_372 - Array Index: 115 //F14 reverse - 0b11111111, //byte 0 - CV_373 - 0b11111111, //byte 1 - CV_374 - 0b11111111, //byte 2 - CV_375 - 0b11111111, //byte 3 - CV_376 + 0b00000000, //byte 0 - CV_373 - Array Index: 116 + 0b00000000, //byte 1 - CV_374 - Array Index: 117 + 0b00000000, //byte 2 - CV_375 - Array Index: 118 + 0b00000000, //byte 3 - CV_376 - Array Index: 119 //F15 forward - 0b11111111, //byte 0 - CV_377 - 0b11111111, //byte 1 - CV_378 - 0b11111111, //byte 2 - CV_379 - 0b11111111, //byte 3 - CV_380 + 0b00000000, //byte 0 - CV_377 - Array Index: 120 + 0b00000000, //byte 1 - CV_378 - Array Index: 121 + 0b00000000, //byte 2 - CV_379 - Array Index: 122 + 0b00000000, //byte 3 - CV_380 - Array Index: 123 //F15 reverse - 0b11111111, //byte 0 - CV_381 - 0b11111111, //byte 1 - CV_382 - 0b11111111, //byte 2 - CV_383 - 0b11111111, //byte 3 - CV_384 + 0b00000000, //byte 0 - CV_381 - Array Index: 124 + 0b00000000, //byte 1 - CV_382 - Array Index: 125 + 0b00000000, //byte 2 - CV_383 - Array Index: 126 + 0b00000000, //byte 3 - CV_384 - Array Index: 127 //F16 forward - 0b11111111, //byte 0 - CV_385 - 0b11111111, //byte 1 - CV_386 - 0b11111111, //byte 2 - CV_387 - 0b11111111, //byte 3 - CV_388 + 0b00000000, //byte 0 - CV_385 - Array Index: 128 + 0b00000000, //byte 1 - CV_386 - Array Index: 129 + 0b00000000, //byte 2 - CV_387 - Array Index: 130 + 0b00000000, //byte 3 - CV_388 - Array Index: 131 //F16 reverse - 0b11111111, //byte 0 - CV_389 - 0b11111111, //byte 1 - CV_390 - 0b11111111, //byte 2 - CV_391 - 0b11111111, //byte 3 - CV_392 + 0b00000000, //byte 0 - CV_389 - Array Index: 132 + 0b00000000, //byte 1 - CV_390 - Array Index: 133 + 0b00000000, //byte 2 - CV_391 - Array Index: 134 + 0b00000000, //byte 3 - CV_392 - Array Index: 135 //F17 forward - 0b11111111, //byte 0 - CV_393 - 0b11111111, //byte 1 - CV_394 - 0b11111111, //byte 2 - CV_395 - 0b11111111, //byte 3 - CV_396 + 0b00000000, //byte 0 - CV_393 - Array Index: 136 + 0b00000000, //byte 1 - CV_394 - Array Index: 137 + 0b00000000, //byte 2 - CV_395 - Array Index: 138 + 0b00000000, //byte 3 - CV_396 - Array Index: 139 //F17 reverse - 0b11111111, //byte 0 - CV_397 - 0b11111111, //byte 1 - CV_398 - 0b11111111, //byte 2 - CV_399 - 0b11111111, //byte 3 - CV_400 + 0b00000000, //byte 0 - CV_397 - Array Index: 140 + 0b00000000, //byte 1 - CV_398 - Array Index: 141 + 0b00000000, //byte 2 - CV_399 - Array Index: 142 + 0b00000000, //byte 3 - CV_400 - Array Index: 143 //F18 forward - 0b11111111, //byte 0 - CV_401 - 0b11111111, //byte 1 - CV_402 - 0b11111111, //byte 2 - CV_403 - 0b11111111, //byte 3 - CV_404 + 0b00000000, //byte 0 - CV_401 - Array Index: 144 + 0b00000000, //byte 1 - CV_402 - Array Index: 145 + 0b00000000, //byte 2 - CV_403 - Array Index: 146 + 0b00000000, //byte 3 - CV_404 - Array Index: 147 //F18 reverse - 0b11111111, //byte 0 - CV_405 - 0b11111111, //byte 1 - CV_406 - 0b11111111, //byte 2 - CV_407 - 0b11111111, //byte 3 - CV_408 + 0b00000000, //byte 0 - CV_405 - Array Index: 148 + 0b00000000, //byte 1 - CV_406 - Array Index: 149 + 0b00000000, //byte 2 - CV_407 - Array Index: 150 + 0b00000000, //byte 3 - CV_408 - Array Index: 151 //F19 forward - 0b11111111, //byte 0 - CV_409 - 0b11111111, //byte 1 - CV_410 - 0b11111111, //byte 2 - CV_411 - 0b11111111, //byte 3 - CV_412 + 0b00000000, //byte 0 - CV_409 - Array Index: 152 + 0b00000000, //byte 1 - CV_410 - Array Index: 153 + 0b00000000, //byte 2 - CV_411 - Array Index: 154 + 0b00000000, //byte 3 - CV_412 - Array Index: 155 //F19 reverse - 0b11111111, //byte 0 - CV_413 - 0b11111111, //byte 1 - CV_414 - 0b11111111, //byte 2 - CV_415 - 0b11111111, //byte 3 - CV_416 + 0b00000000, //byte 0 - CV_413 - Array Index: 156 + 0b00000000, //byte 1 - CV_414 - Array Index: 157 + 0b00000000, //byte 2 - CV_415 - Array Index: 158 + 0b00000000, //byte 3 - CV_416 - Array Index: 159 //F20 forward - 0b11111111, //byte 0 - CV_417 - 0b11111111, //byte 1 - CV_418 - 0b11111111, //byte 2 - CV_419 - 0b11111111, //byte 3 - CV_420 + 0b00000000, //byte 0 - CV_417 - Array Index: 160 + 0b00000000, //byte 1 - CV_418 - Array Index: 161 + 0b00000000, //byte 2 - CV_419 - Array Index: 162 + 0b00000000, //byte 3 - CV_420 - Array Index: 163 //F20 reverse - 0b11111111, //byte 0 - CV_421 - 0b11111111, //byte 1 - CV_422 - 0b11111111, //byte 2 - CV_423 - 0b11111111, //byte 3 - CV_424 + 0b00000000, //byte 0 - CV_421 - Array Index: 164 + 0b00000000, //byte 1 - CV_422 - Array Index: 165 + 0b00000000, //byte 2 - CV_423 - Array Index: 166 + 0b00000000, //byte 3 - CV_424 - Array Index: 167 //F21 forward - 0b11111111, //byte 0 - CV_425 - 0b11111111, //byte 1 - CV_426 - 0b11111111, //byte 2 - CV_427 - 0b11111111, //byte 3 - CV_428 + 0b00000000, //byte 0 - CV_425 - Array Index: 168 + 0b00000000, //byte 1 - CV_426 - Array Index: 169 + 0b00000000, //byte 2 - CV_427 - Array Index: 170 + 0b00000000, //byte 3 - CV_428 - Array Index: 171 //F21 reverse - 0b11111111, //byte 0 - CV_429 - 0b11111111, //byte 1 - CV_430 - 0b11111111, //byte 2 - CV_431 - 0b11111111, //byte 3 - CV_432 + 0b00000000, //byte 0 - CV_429 - Array Index: 172 + 0b00000000, //byte 1 - CV_430 - Array Index: 173 + 0b00000000, //byte 2 - CV_431 - Array Index: 174 + 0b00000000, //byte 3 - CV_432 - Array Index: 175 //F22 forward - 0b11111111, //byte 0 - CV_433 - 0b11111111, //byte 1 - CV_434 - 0b11111111, //byte 2 - CV_435 - 0b11111111, //byte 3 - CV_436 + 0b00000000, //byte 0 - CV_433 - Array Index: 176 + 0b00000000, //byte 1 - CV_434 - Array Index: 177 + 0b00000000, //byte 2 - CV_435 - Array Index: 178 + 0b00000000, //byte 3 - CV_436 - Array Index: 179 //F22 reverse - 0b11111111, //byte 0 - CV_437 - 0b11111111, //byte 1 - CV_438 - 0b11111111, //byte 2 - CV_439 - 0b11111111, //byte 3 - CV_440 + 0b00000000, //byte 0 - CV_437 - Array Index: 180 + 0b00000000, //byte 1 - CV_438 - Array Index: 181 + 0b00000000, //byte 2 - CV_439 - Array Index: 182 + 0b00000000, //byte 3 - CV_440 - Array Index: 183 //F23 forward - 0b11111111, //byte 0 - CV_441 - 0b11111111, //byte 1 - CV_442 - 0b11111111, //byte 2 - CV_443 - 0b11111111, //byte 3 - CV_444 + 0b00000000, //byte 0 - CV_441 - Array Index: 184 + 0b00000000, //byte 1 - CV_442 - Array Index: 185 + 0b00000000, //byte 2 - CV_443 - Array Index: 186 + 0b00000000, //byte 3 - CV_444 - Array Index: 187 //F23 reverse - 0b11111111, //byte 0 - CV_445 - 0b11111111, //byte 1 - CV_446 - 0b11111111, //byte 2 - CV_447 - 0b11111111, //byte 3 - CV_448 + 0b00000000, //byte 0 - CV_445 - Array Index: 188 + 0b00000000, //byte 1 - CV_446 - Array Index: 189 + 0b00000000, //byte 2 - CV_447 - Array Index: 190 + 0b00000000, //byte 3 - CV_448 - Array Index: 191 //F24 forward - 0b11111111, //byte 0 - CV_449 - 0b11111111, //byte 1 - CV_450 - 0b11111111, //byte 2 - CV_451 - 0b11111111, //byte 3 - CV_452 + 0b00000000, //byte 0 - CV_449 - Array Index: 192 + 0b00000000, //byte 1 - CV_450 - Array Index: 193 + 0b00000000, //byte 2 - CV_451 - Array Index: 194 + 0b00000000, //byte 3 - CV_452 - Array Index: 195 //F24 reverse - 0b11111111, //byte 0 - CV_453 - 0b11111111, //byte 1 - CV_454 - 0b11111111, //byte 2 - CV_455 - 0b11111111, //byte 3 - CV_456 + 0b00000000, //byte 0 - CV_453 - Array Index: 196 + 0b00000000, //byte 1 - CV_454 - Array Index: 197 + 0b00000000, //byte 2 - CV_455 - Array Index: 198 + 0b00000000, //byte 3 - CV_456 - Array Index: 199 //F25 forward - 0b11111111, //byte 0 - CV_457 - 0b11111111, //byte 1 - CV_458 - 0b11111111, //byte 2 - CV_459 - 0b11111111, //byte 3 - CV_460 + 0b00000000, //byte 0 - CV_457 - Array Index: 200 + 0b00000000, //byte 1 - CV_458 - Array Index: 201 + 0b00000000, //byte 2 - CV_459 - Array Index: 202 + 0b00000000, //byte 3 - CV_460 - Array Index: 203 //F25 reverse - 0b11111111, //byte 0 - CV_461 - 0b11111111, //byte 1 - CV_462 - 0b11111111, //byte 2 - CV_463 - 0b11111111, //byte 3 - CV_464 + 0b00000000, //byte 0 - CV_461 - Array Index: 204 + 0b00000000, //byte 1 - CV_462 - Array Index: 205 + 0b00000000, //byte 2 - CV_463 - Array Index: 206 + 0b00000000, //byte 3 - CV_464 - Array Index: 207 //F26 forward - 0b11111111, //byte 0 - CV_465 - 0b11111111, //byte 1 - CV_466 - 0b11111111, //byte 2 - CV_467 - 0b11111111, //byte 3 - CV_468 + 0b00000000, //byte 0 - CV_465 - Array Index: 208 + 0b00000000, //byte 1 - CV_466 - Array Index: 209 + 0b00000000, //byte 2 - CV_467 - Array Index: 210 + 0b00000000, //byte 3 - CV_468 - Array Index: 211 //F26 reverse - 0b11111111, //byte 0 - CV_469 - 0b11111111, //byte 1 - CV_470 - 0b11111111, //byte 2 - CV_471 - 0b11111111, //byte 3 - CV_472 + 0b00000000, //byte 0 - CV_469 - Array Index: 212 + 0b00000000, //byte 1 - CV_470 - Array Index: 213 + 0b00000000, //byte 2 - CV_471 - Array Index: 214 + 0b00000000, //byte 3 - CV_472 - Array Index: 215 //F27 forward - 0b11111111, //byte 0 - CV_473 - 0b11111111, //byte 1 - CV_474 - 0b11111111, //byte 2 - CV_475 - 0b11111111, //byte 3 - CV_476 + 0b00000000, //byte 0 - CV_473 - Array Index: 216 + 0b00000000, //byte 1 - CV_474 - Array Index: 217 + 0b00000000, //byte 2 - CV_475 - Array Index: 218 + 0b00000000, //byte 3 - CV_476 - Array Index: 219 //F27 reverse - 0b11111111, //byte 0 - CV_477 - 0b11111111, //byte 1 - CV_478 - 0b11111111, //byte 2 - CV_479 - 0b11111111, //byte 3 - CV_480 + 0b00000000, //byte 0 - CV_477 - Array Index: 220 + 0b00000000, //byte 1 - CV_478 - Array Index: 221 + 0b00000000, //byte 2 - CV_479 - Array Index: 222 + 0b00000000, //byte 3 - CV_480 - Array Index: 223 //F28 forward - 0b11111111, //byte 0 - CV_481 - 0b11111111, //byte 1 - CV_482 - 0b11111111, //byte 2 - CV_483 - 0b11111111, //byte 3 - CV_484 + 0b00000000, //byte 0 - CV_481 - Array Index: 224 + 0b00000000, //byte 1 - CV_482 - Array Index: 225 + 0b00000000, //byte 2 - CV_483 - Array Index: 226 + 0b00000000, //byte 3 - CV_484 - Array Index: 227 //F28 reverse - 0b11111111, //byte 0 - CV_485 - 0b11111111, //byte 1 - CV_486 - 0b11111111, //byte 2 - CV_487 - 0b11111111, //byte 3 - CV_488 + 0b00000000, //byte 0 - CV_485 - Array Index: 228 + 0b00000000, //byte 1 - CV_486 - Array Index: 229 + 0b00000000, //byte 2 - CV_487 - Array Index: 230 + 0b00000000, //byte 3 - CV_488 - Array Index: 231 //F29 forward - 0b11111111, //byte 0 - CV_489 - 0b11111111, //byte 1 - CV_490 - 0b11111111, //byte 2 - CV_491 - 0b11111111, //byte 3 - CV_492 + 0b00000000, //byte 0 - CV_489 - Array Index: 232 + 0b00000000, //byte 1 - CV_490 - Array Index: 233 + 0b00000000, //byte 2 - CV_491 - Array Index: 234 + 0b00000000, //byte 3 - CV_492 - Array Index: 235 //F29 reverse - 0b11111111, //byte 0 - CV_493 - 0b11111111, //byte 1 - CV_494 - 0b11111111, //byte 2 - CV_495 - 0b11111111, //byte 3 - CV_496 + 0b00000000, //byte 0 - CV_493 - Array Index: 236 + 0b00000000, //byte 1 - CV_494 - Array Index: 237 + 0b00000000, //byte 2 - CV_495 - Array Index: 238 + 0b00000000, //byte 3 - CV_496 - Array Index: 239 //F30 forward - 0b11111111, //byte 0 - CV_497 - 0b11111111, //byte 1 - CV_498 - 0b11111111, //byte 2 - CV_499 - 0b11111111, //byte 3 - CV_500 + 0b00000000, //byte 0 - CV_497 - Array Index: 240 + 0b00000000, //byte 1 - CV_498 - Array Index: 241 + 0b00000000, //byte 2 - CV_499 - Array Index: 242 + 0b00000000, //byte 3 - CV_500 - Array Index: 243 //F30 reverse - 0b11111111, //byte 0 - CV_501 - 0b11111111, //byte 1 - CV_502 - 0b11111111, //byte 2 - CV_503 - 0b11111111, //byte 3 - CV_504 + 0b00000000, //byte 0 - CV_501 - Array Index: 244 + 0b00000000, //byte 1 - CV_502 - Array Index: 245 + 0b00000000, //byte 2 - CV_503 - Array Index: 246 + 0b00000000, //byte 3 - CV_504 - Array Index: 247 //F31 forward - 0b11111111, //byte 0 - CV_505 - 0b11111111, //byte 1 - CV_506 - 0b11111111, //byte 2 - CV_507 - 0b11111111, //byte 3 - CV_508 + 0b00000000, //byte 0 - CV_505 - Array Index: 248 + 0b00000000, //byte 1 - CV_506 - Array Index: 249 + 0b00000000, //byte 2 - CV_507 - Array Index: 250 + 0b00000000, //byte 3 - CV_508 - Array Index: 251 //F31 reverse - 0b11111111, //byte 0 - CV_509 - 0b11111111, //byte 1 - CV_510 - 0b11111111, //byte 2 - CV_511 - 0b11111111, //byte 3 - CV_512 + 0b00000000, //byte 0 - CV_509 - Array Index: 252 + 0b00000000, //byte 1 - CV_510 - Array Index: 253 + 0b00000000, //byte 2 - CV_511 - Array Index: 254 + 0b00000000, //byte 3 - CV_512 - Array Index: 255 }; // #define CV_33 0b00000001 //F0 (Licht) vorwärts (MSB) A8 - A1 (LSB) // #define CV_34 0b00000010 //F0 (Licht) rückwärts (MSB) A8 - A1 (LSB) diff --git a/multicore.c b/multicore.c index 965d689..7b9e760 100644 --- a/multicore.c +++ b/multicore.c @@ -32,7 +32,7 @@ uint8_t index_old; bool get_current_direction(){ - return false; + return true; } void emergency_break(){ @@ -49,20 +49,26 @@ void set_outputs() for (uint8_t i = 0; i < SIZE_FUNCTION_BIT_ARRAY; i++) { if (function_bit_array[i]) - { - uint8_t mask = 0b00000001; - for (uint8_t j = 0; j < 8; j++) + { + bool direction = get_current_direction(); // true == forward , false == reverse + uint8_t func_cv_0 = CV_FUNCTION_ARRAY[4+i*8-4*direction]; + uint8_t func_cv_1 = CV_FUNCTION_ARRAY[5+i*8-4*direction]; + uint8_t func_cv_2 = CV_FUNCTION_ARRAY[6+i*8-4*direction]; + uint8_t func_cv_3 = CV_FUNCTION_ARRAY[7+i*8-4*direction]; + uint32_t func_cv = (func_cv_0)+(func_cv_1<<8)+(func_cv_2<<16)+(func_cv_3<<24); + uint32_t mask = 1; + for (uint8_t j = 0; j < 32; j++) { - uint8_t bit_value = (mask&CV_FUNCTION_ARRAY[i])>>j; - //gpio_put(j,bit_value); - printf("GPIO: %d set to: %d\n",j,bit_value); - mask = mask << 1; + uint32_t bit_value = (func_cv&mask)>>j; + printf("GPIO: %u, set to: %d\n",j,bit_value); + //gpio_put(j,bit_value); + mask = mask<<1; } + // printf("func_cv: %u\n",func_cv); + // printf("func: F%u, direction: %u\n",func,direction); + //printf("func_cv_0_index: %d func_cv_1_index: %d func_cv_2_index: %d func_cv_3_index: %d \n",4+257+i*8-4*direction,4+258+i*8-4*direction,4+259+i*8-4*direction,4+260+i*8-4*direction); } - // bool current_bit = function_bit_array[i]; - // uint8_t current_CV = CV_FUNCTION_ARRAY[i]; - // printf("GPIO: %d - %d ; ",i,function_bit_array[i]); } printf("\n"); }