add libfixmath
 add fixed point
merge kalman
six states Kalman filter working on avr atmega2560