function in pru for getting the stabil feedback and the feedthrough
stst done, looks like a mass scaling missing