I believe the Autotune project has a feature to do this:

http://energy.gov/eere/buildings/downloads/autotune

http://evenstar.ornl.gov/trinity/

Dan