ASIR algorithm in particle filter

BPF算法（回溯粒子滤波），还包括判断粒子是否有效的子函数，以及其中用到的判断两条直线是否相交的函数（用来判断轨迹是否与墙壁相交）。- three particle filter algorithms(SIR,ASIR and BPF) for indoor pedestrian navigation.Also include a function for particle validation detection and a fu