Gripper and Color sensor basic functionality testing.
Dependencies: mbed
gripper.cpp
- Committer:
- z_g13
- Date:
- 2016-03-26
- Revision:
- 0:b30091b30223
File content as of revision 0:b30091b30223:
#include "gripper.h" #include "mbed.h" Gripper::Gripper(PinName gripPin, PinName wristPin) : gripPwm(gripPin), wristPwm(wristPin) { gripPwm.period_us(PWM_PER); wristPwm.period_us(PWM_PER); gripPwm.pulsewidth_us(GRIP_DEF); wristPwm.pulsewidth_us(WRIST_DEF); } void Gripper::grip() { gripPwm.pulsewidth_us(GRIP_CLOSE); } void Gripper::release() { gripPwm.pulsewidth_us(GRIP_OPEN); } void Gripper::lift() { wristPwm.pulsewidth_us(WRIST_UP); } void Gripper::lower() { wristPwm.pulsewidth_us(WRIST_DOWN); }