fix errors and warnings on SIMPLEFOC_DISABLE_DEBUG #772

Job	Run time
Test compiling (arduino:avr:uno)	2m 40s
Test compiling (arduino:sam:arduino_due_x)	53s
Test compiling (arduino:avr:mega)	33s
Test compiling (arduino:avr:leonardo)	27s
Test compiling (arduino:samd:nano_33_iot)	3m 8s
Test compiling (adafruit:samd:adafruit_metro_m4)	2m 3s
Test compiling (esp32:esp32:esp32doit-devkit-v1)	4m 23s
Test compiling (esp32:esp32:esp32s2)	2m 44s
Test compiling (esp32:esp32:esp32s3)	3m 31s
Test compiling (STMicroelectronics:stm32:GenF1:pnum=BLUEPILL_F103C8)	3m 21s
Test compiling (STMicroelectronics:stm32:Nucleo_64:pnum=NUCLEO_F411RE)	7m 9s
Test compiling (STMicroelectronics:stm32:GenF4:pnum=GENERIC_F405RGTX)	3m 13s
Test compiling (STMicroelectronics:stm32:GenL4:pnum=GENERIC_L475RGTX)	10m 14s
Test compiling (STMicroelectronics:stm32:Disco:pnum=B_G431B_ESC1)	1m 59s
Test compiling (arduino:mbed_rp2040:pico)	1m 11s
	47m 29s

Provide feedback