본문으로 건너뛰기

F/T 센서

Neuromeka Indy7 v3 로봇의 툴 플랜지와 그리퍼 사이에 Aidin AFT200-D80 힘/토크(F/T) 센서를 달 수 있습니다. 툴 보드가 EtherCAT 버스로 값을 넘겨 주므로 따로 배선하거나 드라이버를 띄우지 않아도 됩니다.

한눈에 보기​

단계어디서결과
1. 설정로봇 프로필에서 센서 모델 선택다음 스택 기동부터 펜던트·TUI·Lab 화면에 값이 보입니다
2. 영점펜던트 F/T 카드, 또는 ft_sensor/zero 서비스센서가 지금 값을 0으로 센서 안에 저장합니다(전원을 꺼도 유지)
3. 읽기플러그인 measured.wrench()영점이 이미 빠진 값이 옵니다
4. Payload 빼기(선택)펜던트 Payload 측정 → 플러그인 ToolLoad자세와 상관없이 외력만 남습니다
값의 기준

값은 센서 좌표 그대로이고 중력 보상을 하지 않습니다. 그리퍼 무게는 영점을 잡은 자세에서만 0으로 보이고, 자세가 바뀌면 다시 힘으로 나타납니다. 이것까지 빼려면 4단계를 씁니다.

센서 축은 툴 좌표축과 방향이 같고, 센서에 가해진 힘은 양(+)의 값으로 읽힙니다. 툴을 +Z 방향으로 밀면 Fz 값이 커집니다.

1. 설정​

로봇 프로필에서 F/T 센서 모델을 고릅니다. 아래 어디에서 해도 됩니다.

  • TUI 설정(,)의 로봇 편집
  • Teaching Pendant 설정의 로봇 편집
  • plem profile set-ft-sensor <로봇> aft200_d80 (해제는 none)

저장한 값은 다음 스택 기동부터 적용됩니다. 그리퍼·카메라는 센서와 따로 고릅니다.

  • 지원하지 않는 로봇이면 저장을 거부합니다. AFT200-D80 센서를 지원하는 로봇은 Neuromeka Indy7 v3 하나뿐입니다.
  • 툴 보드 펌웨어에 F/T 중계가 없으면 저장은 되고, 기동 뒤 「The tool board provides no F/T signal」로 알려 줍니다.
  • 프로필을 손으로 고쳐 센서를 적었는데 로봇 설명(URDF)에 센서가 없으면, 로봇은 기동하지만 F/T 센서를 켜지 않고 로그에 경고를 남깁니다. 펜던트에는 F/T 칩이 나오지 않고 TUI 화면에는 「no signal」이 계속 보입니다. 센서가 없는 로봇이면 프로필에서 해제하세요.
카메라가 그리퍼에 붙어 있다면

센서를 끼우거나 빼면 툴 끝 높이가 바뀌어 카메라 위치도 달라집니다. 저장·기동은 막지 않고 경고만 한 번 띄웁니다. 카메라를 계속 쓰려면 캘리브레이션을 다시 하세요.

2. 영점 잡기​

펜던트 F/T 카드의 영점 버튼(화면 구성)으로 잡거나, 프로그램에서 ft_sensor/zero 를 부릅니다. 누르기 전에 툴에 아무것도 닿지 않게 하고, 값을 볼 자세로 로봇을 두세요.

  • 성공: 로봇이 영점 직후 값을 다시 읽어, 축마다 힘 1 N·토크 0.05 N·m 이내일 때만 성공을 알립니다. 아니면 그때 값과 함께 실패를 돌려줍니다. 확인하는 사이 툴이 움직이거나 무언가에 닿아도 실패합니다.
  • 로봇이 사유와 함께 거부: 센서 기동 절차 중, 센서 미인식, 로봇 이동 중, 이전 영점 요청 처리 중. 펜던트에서 누르든 ROS 2 서비스로 부르든 똑같습니다.
  • 펜던트만 잠그는 경우: Job 실행 중, Jog 중. 프로그램에서 부를 때는 호출하는 쪽이 시점을 고르세요.
툴에 아무것도 닿지 않게 한 뒤 잡으세요

OVER_RATED·OUT_OF_RANGE 상태에서도 영점은 막지 않습니다. 하중을 모두 뺀 뒤 영점을 잡는 것이 두 상태를 푸는 방법입니다(상태). 하중이 걸린 채 잡으면 틀린 영점이 저장되고, 그 영점을 쓰는 동안에는 실제 힘이 정격을 넘어도 정격 초과 경고가 늦게 뜹니다.

3. 토크 컨트롤러 플러그인에서 읽기​

커스텀 토크 컨트롤러의 compute() 에서 매 제어 주기 읽습니다. 플러그인은 plem init my_controller 로 만들고, compute() 는 include/my_controller/my_controller.hpp·src/my_controller.cpp 에 있습니다. 영점은 센서가 이미 적용했으니 받은 값을 그대로 쓰세요. 아래 예제는 보기 쉽게 한 파일에 모았습니다.

#include <plem/control/plugin/torque_plugin_sdk.hpp>

namespace my_controller {
using namespace plem::control::plugin;

class MyController : public TunableController {
public:
using TunableController::TunableController;

void compute(const Measured& measured, const Target& target,
double* output_torque, bool /*free_drive*/) const override {
for (std::size_t j = 0; j < measured.dof(); ++j) {
output_torque[j] = 0.0; // ← 여기에 힘 없이도 도는 제어 법칙
}

const auto w = measured.wrench(); // 영점이 빠진 값
if (!w) {
return; // 센서 없음·이번 주기 무효 → 힘 항 없이
}
const double fz = w->force.z; // [N]
const double tx = w->torque.x; // [N·m]
// fz·tx 로 힘 항을 output_torque 에 더한다
}

void reset() noexcept override {}
};

} // namespace my_controller

PLEM_TORQUE_PLUGIN(my_controller::MyController);
접근자돌려주는 것
measured.wrench()force.{x,y,z} [N]·torque.{x,y,z} [N·m]·frame_id(센서 프레임). 값이 없으면 std::nullopt
measured.wrench_state()값이 없는 이유. 값이 있으면 OK (표)
measured.wrench_zero_seq()영점 명령이 들어갈 때마다 바뀌는 번호(펜던트가 실패라고 알려도 바뀔 수 있음)
출력 토크에 NaN 값을 넣지 마세요

NaN 값이 나가면 로봇이 모든 관절 토크를 0으로 하고 보호 정지합니다. wrench() 가 비어 있는 주기에는 힘 항을 빼고 제어하세요.

  • 센서가 없는 로봇에서도 플러그인은 그대로 올라가고, wrench() 는 늘 비어 있습니다.
  • frame_id 는 센서의 측정 원점입니다. AFT200-D80 센서에서는 벤더 CAD 기준으로 F/T 스택 꼭대기보다 14.8 mm 아래입니다.
  • F/T 읽기가 없던 때 빌드한 플러그인은 다시 빌드하지 않아도 전과 똑같이 동작합니다.

영점이 바뀐 순간 알아채기​

플러그인이 힘 기준값을 따로 들고 있을 때만 필요합니다. 영점을 잡는 동안은 ZEROING(값 없음)이고, 끝나는 순간 wrench_zero_seq() 가 바뀝니다. 그 첫 주기의 값 변화는 접촉이 아니라 영점 때문이니, 거기서 기준을 다시 잡습니다.

if (measured.wrench_zero_seq() != last_zero_seq_) { // compute() 안, w 가 유효할 때
last_zero_seq_ = measured.wrench_zero_seq(); // 멤버 — compute() 가 const 라 mutable
baseline_fz_ = w->force.z;
}

4. Payload 빼기 (선택)​

자세와 상관없이 외력만 쓰고 싶을 때 씁니다. 재지 않아도 경고하거나 막지 않습니다.

측정 중 로봇이 크게 움직입니다

첫 측정 자세까지 팔 전체가 움직일 수 있습니다. 시작하기 전에 주변을 비우고, 툴에 아무것도 닿지 않게 하세요.

  1. 로봇을 TRAJECTORY 모드로 둡니다. 보호 정지 중이 아니어야 합니다. BRAKED 등 다른 모드에서는 측정 자세로 움직이지 않습니다.

  2. F/T 카드의 Payload 측정 → 측정 시작을 누릅니다. 로봇이 정해진 측정 자세 4곳(관절각 고정)을 돌고 원래 자세로 돌아옵니다. 30초 안팎 걸리고, 카드의 중지로 언제든 멈춥니다.

    Payload 측정 확인 창. 로봇이 정해진 측정 자세 4곳을 돌고 원래 자세로 돌아온다는 안내와, 결과는 복사만 되고 따로 저장되지 않는다는 안내, 취소·측정 시작 버튼이 있다.

  3. 결과의 복사를 누릅니다. 질량 [kg]과 센서 프레임 기준 무게중심 [m] 4개 값이 복사됩니다. 「잔차가 큽니다」가 나오면 툴·케이블이 아무 데도 닿지 않게 하고 다시 잽니다.

    측정을 마친 F/T 카드. 아래에 질량 1.75 kg · 무게중심 (5, -1, 103) mm, 측정 품질 양호, 복사할 값 {1.753, {0.005, -0.001, 0.103}}과 복사 버튼이 있다.

  4. 복사한 값으로 ToolLoad 를 만들고, wrench() 대신 compensate() 를 씁니다. tool_load.hpp 는 plem init 이 늘 함께 만듭니다. 이 값은 plem 쪽에 저장되지 않으니 내 프로젝트(코드·파일·plugin_config_json)에 두세요. §3 예제에서 바뀌는 곳은 #include 줄과 멤버, using TunableController::TunableController; 줄을 대신하는 생성자, compensate() 호출입니다.

#include "my_controller/tool_load.hpp"

explicit MyController(const PlemPluginContext* ctx)
: TunableController(ctx),
tool_load_(ctx, ToolLoad::Params{1.753, {0.005, -0.001, 0.103}}) {} // 3단계에서 복사한 값

const auto f = tool_load_.compensate(measured); // compute() 안 — 외력(영점·Payload 제외)
ToolLoad tool_load_; // private 멤버
기준을 잡는 때자동으로, 그 순간의 값을 기준으로 삼습니다. 기동 뒤 로봇이 처음 150 ms 정지했을 때(보통 첫 브레이크 해제 직후)와 영점을 다시 잡은 뒤 150 ms 정지했을 때입니다. 그 전에는 compensate() 가 std::nullopt 입니다. 기동할 때마다 영점을 잡을 필요는 없습니다
그 순간에는툴에 아무것도 닿아 있지 않아야 합니다. 기준이 어긋났다면 아무것도 닿지 않은 상태에서 영점을 한 번 잡으면 바로잡힙니다
F/T 센서가 없으면ToolLoad 생성이 실패해 플러그인이 올라가지 않습니다
다시 잴 때그리퍼·카메라·장착을 바꿨을 때. 측정 자세가 정의된 로봇은 지금은 Indy7 하나뿐입니다
남는 오차
  • 기준 자세에서 멀어질수록 오차가 커집니다. Payload 무게가 센서에 걸리는 방향이 바뀐 만큼의 57% 정도가 남습니다. Indy7·RG6 조합에서는 보통 0.40.7 N, 손목을 60° 넘게 돌리면 약 1.2 N이었습니다. 접촉 판정 기준은 이보다 크게 잡으세요.
  • 정지·저속을 전제로 합니다. 관성력 항이 없습니다.
  • 기준을 잡은 뒤의 센서 표류는 빠지지 않습니다.
  • 설치 기울기, 케이블 장력, 그리퍼 손가락 위치, 파지물 무게는 반영되지 않습니다. 손가락은 평소 상태로 두고 잽니다.

화면에서 보기​

  • Teaching Pendant: 3D 화면의 F/T 칩·카드, 하단 바의 F/T 경고(화면 구성)
  • TUI: 로봇 상세의 F/T 줄(로봇 제어)
  • Plem Lab: 그래프로 보고 파일로 내보내기(신호)
  • 프로그램과 스킬에서는 힘 값을 조건이나 입력으로 쓸 수 없습니다.

정격과 상태​

정격은 힘 200 N·토크 15 N·m입니다. 복합 부하는 |Fxy|/200 + |Tz|/15 와 |Fz|/200 + |Txy|/15 중 큰 값입니다. 105%를 넘으면 값을 무효로 하고 경고하며, 100% 아래로 내려오면 풀립니다.

OK 가 아니면 값은 무효(NaN)이고 플러그인의 wrench() 는 비어 있습니다. 화면에는 상태 문장이 나오고, ROS 2 상태 토픽과 플러그인 wrench_state() 에는 같은 이름의 코드가 갑니다.

state상태 문장(앞부분)뜻조치
OKOK정상—
ZEROINGZeroing the F/T sensor영점 진행 중(보통 1초 이내, 길면 몇 초). 끝나면 zero_seq 가 바뀌고 값이 돌아옵니다기다립니다
STARTINGThe F/T sensor is starting up스택 기동 직후 센서 준비 중. 로봇 버스를 먼저 기다려 수십 초 걸릴 수 있습니다기다립니다
OVER_RATEDRated load exceeded정격 초과. 툴에 아무것도 닿지 않았는데 뜨면, 영점이 틀리게 저장됐거나 영점을 잡은 자세와 지금 자세가 달라 Payload 무게가 크게 나타난 것일 수 있습니다센서에 걸린 힘을 줄입니다. 아무것도 닿지 않았는데 계속되면 작업 자세에서 영점을 다시 잡습니다
OUT_OF_RANGEForce or torque exceeded the measurement range한 축이라도 측정 범위(토크 약 16.4 N·m, 힘 약 655 N)를 넘어 값이 뒤집혔을 수 있음. 샘플 사이 급변으로 판단하므로, 아주 짧고 큰 충격이나 기동 때 이미 넘어 있던 하중은 못 잡을 수 있습니다걸린 힘을 모두 풀고 영점을 다시 잡습니다
NOT_RESPONDINGThe F/T sensor is not respondingEtherCAT 통신 끊김, 케이블 분리·접촉 불량, 툴 보드 자동 인식 실패, 센서 고장 중 하나통신 상태와 케이블을 확인하고, 로봇 전원을 껐다 켠 뒤 로봇 스택을 재시작합니다. 센서 모드 설정은 기동 때만 하므로 재시작이 확실한 방법입니다
FROZENThe F/T sensor values are not updating6축 원시값이 20 ms 넘게 전혀 바뀌지 않음. 케이블이 빠져도 툴 보드가 마지막 값을 계속 보내므로 무응답으로 봅니다. 케이블 분리·접촉 불량, 센서 전원, 툴 보드 이상일 수 있음케이블과 연결을 확인합니다. 값이 다시 바뀌면 저절로 풀립니다. 다시 연결한 직후에는 값이 한동안(실제 로봇에서 수십 초) 표류할 수 있으니 기다린 뒤 영점을 다시 잡습니다
NO_RELAYThe tool board provides no F/T signal툴 보드 펌웨어가 F/T 중계를 지원하지 않거나 이 로봇에 중계가 없음로봇 기동 로그의 F/T 경고를 확인합니다
STALE(플러그인만)새 값이 5 ms 넘게 오지 않음. 계속될 수 있습니다힘 항 없이 제어합니다
NO_SENSOR(플러그인만)센서가 없는 로봇—

STARTING·ZEROING·OVER_RATED·OUT_OF_RANGE 는 경고(WARN), 나머지 이상은 오류(ERROR) 수준입니다. 센서 문제로 로봇이 멈추지는 않고, 그동안 F/T 값만 무효가 됩니다.

ROS 2 인터페이스로 쓰기​

로봇 이름이 robot_1 이면 이렇게 확인합니다.

ros2 topic echo /robot_1/ft_sensor/wrench # 힘·토크 (100 Hz)
ros2 topic echo /robot_1/ft_sensor/status # 상태 — values 의 state·zero_seq
ros2 service call /robot_1/ft_sensor/zero std_srvs/srv/Trigger # 영점

토픽·서비스의 전체 규칙(NaN, zero_seq, 좌표 변환, 웹 클라이언트 주의점)은 ROS 2 인터페이스에 있습니다.