PSO(Particle Swarm Optimization)을 이용한 매니퓰레이터의 최종 위치 추정
매니퓰레이터 매니퓰레이터는 엑추에이터의 각도의 변화를 이용하여 자세를 변화한다. 우리가 목표로 하는 3차원 공간상의 좌표가 있다면, 로봇팔이 그 위치까지 도달할 수 있도록 제어해야 한다. 3차원 공간에서 매니퓰레이터가 6-DOF를 가지는 non-redunduncy 한 문제에서는 Inverse Kinematics(IK)를 사용하여 목표점까지 제어가 가능하다. 하지만 매니퓰레이터가 6-DOF를 초과하는 redunduncy한 상황은 조금 다르다. Redunduncy상황에서 IK를 풀기 위해서는 Jacobian이 정방행렬이 아니어서 pseudo inverse를 이용하여 계산을 한다. 이때 pseudo inverse를 이용하다 보니 수치계산으로 인한 singularity가 발생하곤 한다. 이러한 singulari..
2023.05.08