fixed pg70 interface
finished force torque sensor interface