changed 30Hz rate to 40Hz
WIP getting unit tests to pass