Graph SLAM with Example Code
def main(): print(__file__ + " start!!") time = 0.0 # RFID positions [x, y, yaw] RFID = np.array([[10.0, -2.0, 0.0], [15.0, 10.0, 0.0], [3.0, 15.0, 0.0], [-5.0, 20.0, 0.0], [-5.0, 5.0, 0.0] ]) # State Vector [x y yaw v]' xTrue = np.zeros((STATE_SIZE, 1)) xDR = np.zeros((STATE_SIZE, 1)) # Dead reckoning # history hxTrue = [] hxDR = [] hz = [] d_time = 0.0 init = False main에서 변수를 초기화하는 부분입니다. RFID..
2021. 10. 27.
EKF SLAM with Example Code
역시 PythonRobotics 의 예제를 가져와봤습니다. 이전 포스팅의 EKF SLAM이 실제로 어떻게 구현되어있는지, 어떤 차이가 있는지 알아보기 위한 코드 리뷰입니다. 물론 실제 플랫폼, 센서를 갖고 하는 것이 아닌 시뮬레이션이기 때문에 그 부분은 감안 해야하겠습니다. def main(): print(__file__ + " start!!") time = 0.0 # RFID positions [x, y] RFID = np.array([[10.0, -2.0], [15.0, 10.0], [3.0, 15.0], [-5.0, 20.0]]) # State Vector [x y yaw v]' xEst = np.zeros((STATE_SIZE, 1))# for predicted state vector xTrue ..
2021. 9. 23.
