Made slitherto work, added IR and accelerometer stop, used accTest2 to try Kalman again, didn't work anymore :(