Using P-Q Theory for a shunt current compensation

Hi, I've tried to program a code that I could extract the fifth harmonic current of a non-linear load. in order to get it, I have to use the PQ-Theory. anyone ever had to do this using the matlab code and based on the theory PQ? Can you help me?thanks