This is a merge of the math and control library pieces from https://github.com/jgoppert/Firmware.git