Initial write of motor tuning unit. Need to write a test bench for it and simulate to check for effectiveness