Поиск:

http://home.earthlink.net/~david.schultz/rnd/2004/KalmanApogeeII.pdf

Так есть же известная статья на эту тему: определение апогея по ускорению с коррекцией по данным барометрического альтиметра через фильтр Калмана.