pid and interrupt

nasbyc · Joined: 27 Apr 2009 Posts: 50

I have developed pid algorithms to control motor pwm. I trien to use an interrupt to read potentiometer (10 bit) to determine the position of the motor. The problem that I encounter is that the timer will always interrupt and never execute program in the main. I already change the prescaler but haven't manage to solve this problem.

Alternative method is that I removed the interrupt, and but the code in the main. the problem is that for pid: esp for integral and derivative term. sampling freq need to be known. Because by using interrupt you can just st when is it, it going to read.

PCM programmer · Joined: 06 Sep 2003 Posts: 21708

This code does not look correct:

nasbyc · Joined: 27 Apr 2009 Posts: 50

My mistake about the u_signal. But my problem is about the timer. It executes too fast thus ignores the program in the main loop. It just keep reading the pot.

Ttelmah · Joined: 11 Mar 2010 Posts: 19436

Think about the timing of reading the ADC. This takes typically 11cycles of the ADC clock, which is allowed to be 1.6uSec _minimum_ for your chip. ADC_CLOCK_iINTERNAL, will give nominally 4uSec _but_ is not recommended for chip operation above 1MHz, and can be up to 6uSec.....
Anyway, ignoring the 'not recommended' bit, the ADC conversion will then take up to about 66uSec, plus the time to read the register (at least another coouple of uSec). Then look at your other operations in the interrupt. 16bit subtraction 1.4uSec. 16bit comparison (about the same). Then a double signed comparison - probably 5uSec+. Then if the conditions are met, several other operations. Add the time to get into and out of the interrupt (about 12uSec), something of the order of 95uSec 'quickest', and probably worse. 1/10000th second....
First thing you can do to improve things _massively_, is to not perform the ADC conversion while you are actually waiting.
So:
At the start of main, set the adc clock to be FOSC/32, not ADC_CLOCK_INTERNAL.
Select the adc channel just once here.
wait 10uSec here, and send the command

read_adc(ADC_START_ONLY);

Then setup the interrupts and start them.

Then in your interrupt routine, get rid of the set_adc_channel (pointless, and wastes time), and use:

Theta_out=read_adc(ADC_READ_ONLY);

At the end of the interrupt code, as the last instruction use:

read_adc(ADC_START_ONLY);

Doing this the ADC conversion is performed _between_ the interrupts, with you reading the value from the last conversion at the start of the routine, and then starting a new conversion before the next interrupt - will probably double the speed of your interrupt routine in one go!....

Now, do you really need the signed values?.
If you tested for Desired_angle being less than Theta_out, you could set a flag for direction, and perform the arithmetic all on +ve values.

Your main loop is going to take an age to execute. Floating point arithmetic, prints, etc. etc.. Even with less time in the interrupt, it is going to be _slow_. If you look at code examples for PID, they will use _scaled_ integer arithmetic, rather than float.

Best Wishes

nasbyc · Joined: 27 Apr 2009 Posts: 50

Ttelmah · Joined: 11 Mar 2010 Posts: 19436

No, you are missing the point.
You don't need signed values.
What you do is have a flag bit called (say) 'direction'. Then test just once in the operation, which number is greater than the other. and if (say) 'where you want to be' is below 'where you are', then set 'direction' to 'out' (so the motor is going up), and subtract where you want to be from where you are in your calculation using unsigned. Similarly if where you want to be is above where you are, set direction to 'in'. and instead subtract where you are from where you want to be. This way your calculations can all be _unsigned_, and a lot faster. Similarly then, 'limit tests', will always apply at the same point, on the single +ve 'offset' value, a lot faster. You can directly control the power bridge with the direction value, again reducing calculation.

Best Wishes

nasbyc · Joined: 27 Apr 2009 Posts: 50

Sorry for the late reply. I already changed my program, which disable my interrupt when met the condition (pidflag == 1) and enable it back when the calculation complete. It is because it never calculates in the main loop if I don't disable the interrupt even I changed all to unsigned calc.

About the unsigned value. Yes I understand about setting the dirrection of motor you just can compare whether the desired angle larger or smaller than the actual angle. But the one that confuses me is that with the differential term. Do I need to make it unsigned ? For the derivative term: