Seems to work. Needs testing with signal gen.