@Yogurt_Man Thank you! Here is the code and the screenshot:
/*******************************************************************************
* Copyright 2016 ROBOTIS CO., LTD.
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*******************************************************************************/
/* NOTE: Please check if your DYNAMIXEL supports Current-based Position Control mode
* Supported Products : MX-64(2.0), MX-106(2.0), All X series(except XL-320, XL430-W250)
*/
#include <DynamixelShield.h>
#if defined(ARDUINO_AVR_UNO) || defined(ARDUINO_AVR_MEGA2560)
#include <SoftwareSerial.h>
SoftwareSerial soft_serial(7, 8); // DYNAMIXELShield UART RX/TX
#define DEBUG_SERIAL soft_serial
#elif defined(ARDUINO_SAM_DUE) || defined(ARDUINO_SAM_ZERO)
#define DEBUG_SERIAL SerialUSB
#else
#define DEBUG_SERIAL Serial
#endif
const uint8_t DXL_ID = 1;
const float DXL_PROTOCOL_VERSION = 2.0;
DynamixelShield dxl;
//This namespace is required to use Control table item names
using namespace ControlTableItem;
void setup() {
// put your setup code here, to run once:
// For Uno, Nano, Mini, and Mega, use UART port of DYNAMIXEL Shield to debug.
DEBUG_SERIAL.begin(115200);
// Set Port baudrate to 57600bps. This has to match with DYNAMIXEL baudrate.
dxl.begin(57600);
// Set Port Protocol Version. This has to match with DYNAMIXEL protocol version.
dxl.setPortProtocolVersion(DXL_PROTOCOL_VERSION);
// Get DYNAMIXEL information
dxl.ping(DXL_ID);
// Turn off torque when configuring items in EEPROM area
dxl.torqueOff(DXL_ID);
dxl.setOperatingMode(DXL_ID, OP_CURRENT_BASED_POSITION);
dxl.torqueOn(DXL_ID);
}
void loop() {
// put your main code here, to run repeatedly:
// Set Goal Current using RAW value
dxl.setGoalCurrent(DXL_ID, 200);
dxl.setGoalPosition(DXL_ID, 350.0, UNIT_DEGREE);
// Print present current
delay(500);
DEBUG_SERIAL.print("Present Current(raw) : ");
DEBUG_SERIAL.println(dxl.getPresentCurrent(DXL_ID));
delay(5000);
// Set Goal Current 3.0% using percentage (-100.0 [%] ~ 100.0[%])
dxl.setGoalCurrent(DXL_ID, 3.0, UNIT_PERCENT);
dxl.setGoalPosition(DXL_ID, 0);
// Print present current in percentage
delay(500);
DEBUG_SERIAL.print("Present Current(ratio) : ");
DEBUG_SERIAL.println(dxl.getPresentCurrent(DXL_ID, UNIT_PERCENT));
delay(5000);
}