oGrUtR - Online C Compiler & Debugging Tool

#include <stdio.h>
#include <stdint.h>
#include <stdbool.h>

#define NUM_DRV_REGS (18)
#define PWM_MODE_7_INDEPENDENT_FETS (0x70)
#define PWM_MODE_MASK (0x70)
#define DRV8340_WRITE (0x0000)

static inline uint32_t DRV8340_ADDR(uint32_t n)
{
    return ((n) << 8);
}

int main(void) {
	// your code goes here
	bool isPoly = true;
	int reg = 4;
	int val = 0x000a;
	if (reg >= 0 && reg < NUM_DRV_REGS)
	{
	    uint8_t u8_val =((uint32_t)val) & 0xff; /* Only 8 bits of data available */
	    printf("\n%u", (u8_val & PWM_MODE_MASK));
	    printf("Setting %s DRV[%d] = 0x%04x\n",
	        isPoly ? "Poly" : "Elevation",
	        reg,
	        u8_val);
	    if (4 == reg &&
	        (u8_val & PWM_MODE_MASK) != PWM_MODE_7_INDEPENDENT_FETS &&
	        (u8_val & PWM_MODE_MASK) != 0)
	    {
	        printf("Error: PWM_MODE must be 0 or 7, write not executed\n");
	    }
	    else if (reg >= 6 && reg <= 8 && (u8_val >> 4) != (u8_val & 0xf))
	    {
	        printf("Error: Setting IDRIVEP_* must set same value for low and high!\n");
	    }
	    else if (isPoly)
	    {
	        if (4 == reg)
	        {
	            // pr->polyDriverModeZero = ((u8_val & PWM_MODE_MASK)==0);
	        }
	        // uint16_t polyTransmitData =  DRV8340_WRITE | DRV8340_ADDR(reg) | (u8_val);
	    // (void) System_SPI_AzimuthReadWrite(&polyTransmitData, sizeof(polyTransmitData),NULL,0);
	    }
	    else
	    {
	        if (4 == reg)
	        {
	            // pr->elevationDriverModeZero = ((u8_val & PWM_MODE_MASK)==0);
	        }

	        // uint16_t elevationTransmitData = DRV8340_WRITE | DRV8340_ADDR(reg) | (u8_val);
	    // (void) System_SPI_ElevationReadWrite(&elevationTransmitData, sizeof(elevationTransmitData),NULL,0);

	    }
	}

	return 0;
}