With the development of MEMS sensors, pedestrian navigation has been a popular research. The paper realizes step detection and estimation for step length by only vertical accelerometer. It determines initial heading using accelerometers and magnetometers and calculates latter heading using gyroscope