Copyright © 2001-2018, Dr Robot Inc. All Rights Reserved.
www.DrRobot.com
V.07.08.18.Q
- 23 -
After “Accel”, the data will be 3-axis raw accelerometer sensor data.
After “Comp”, the data will be 3-axis raw compass sensor data.
Camera with Two Way Audio
You need to install the camera ActiveX control on your system by running the “AXISMediaControlSDK.exe”. You
could find some sample codes (C++, C#, VB) in C:\Program Files\Axis Communications\AXIS Media Control
SDK\samples and the corresponding SDK documents in C:\Program Files\Axis Communications\AXIS Media
Control SDK\doc.
By using the Microsoft’s “Windows Media Encoder 9” and Axis video capture driver, you could also access this
camera in Intel’s OpenCV as same as accessing a USB camera.
Manipulator Arm
The manipulator arm is controlled by 2 RoboteQ SDC2130 control boards.
The program will communicate with it via 192.168.0.63, port 10001/10002 using TCP protocol.
You could find the manual from RoboteQ web site. You need to make sure that none of the motors gets stuck
when driving the arm, since this may over-heat and burn the motors and/or motor driver board.
The emergency stop command is “!EX\r” and resume command is “!MG\r”.
Joint Number
Joint1
(Motor Driver
board 1
channel 1)
Encoder : One circle count is 5700
Angle Resolution: 5700/ (2*PI)
This joint is working in position control mode(mode 3):
For example:
Command: !PR 1 -200\r
It will drive this joint up.
Command: !PR 1 200\r
It will drive this joint down.
Command: !P 1 -250\r
It will drive this motor to encoder position -250.(make sure you know where it is
and not in stuck state)
On control board, we set current limitation for this joint. It will enter emergency stop state
when current is over 12A or current over 7A for over 1000ms.
You could read temperature sensor via analog channel 3(AI 3).
The temperature sensor is B57164K103J, you could find how to convert the readings to
temperature from the sample codes.
Joint2(Motor
Driver board 1
channel 2)
Encoder : One circle count is 5700
Angle Resolution: 5700/ (2*PI)
This joint is working in position control mode(mode 3):
For example:
Command: !PR 2 -200\r
It will drive this joint up.
Command: !PR 2 200\r
It will drive this joint down.
Command: !P 2 -250\r
It will drive this motor to encoder position -250.(make sure you know where it is
and not in stuck state)
On control board, we set current limitation for this joint. It will enter emergency stop state
when current is over 8A or current over 6A for over 1000ms.
You could read temperature sensor via analog channel 4(AI 4).
The temperature sensor is B57164K103J, you could find how to convert the readings to
temperature from the sample codes.