SHOW:
|
|
- or go back to the newest paste.
| 1 | package com.sherolchen.msp; | |
| 2 | ||
| 3 | import lejos.nxt.NXTRegulatedMotor; | |
| 4 | ||
| 5 | /** | |
| 6 | * A simple interface to a KTong's ARM!!! MWAHAHAHA | |
| 7 | * But we can make it better...we have the technology | |
| 8 | */ | |
| 9 | ||
| 10 | public class NXTArmAndGripper {
| |
| 11 | ||
| 12 | // Member variables used to keep track of various motors | |
| 13 | private NXTRegulatedMotor turningMotor; | |
| 14 | private boolean turnerReversed = false; | |
| 15 | private NXTRegulatedMotor liftingMotor; | |
| 16 | private boolean lifterReversed = false; | |
| 17 | private NXTRegulatedMotor grippingMotor; | |
| 18 | ||
| 19 | // Constructor which assumes an orientation to the various motors | |
| 20 | public NXTArmAndGripper(NXTRegulatedMotor turner, | |
| 21 | NXTRegulatedMotor lifter, | |
| 22 | NXTRegulatedMotor gripper) {
| |
| 23 | turningMotor = turner; | |
| 24 | liftingMotor = turner; | |
| 25 | grippingMotor = gripper; | |
| 26 | // Assumes gripper starts off in closed position. | |
| 27 | grippingMotor.resetTachoCount(); | |
| 28 | } | |
| 29 | ||
| 30 | // Constructor which does not assume an orientation to the various motors | |
| 31 | public NXTArmAndGripper(NXTRegulatedMotor turner, boolean turnReverse, | |
| 32 | NXTRegulatedMotor lifter, boolean liftReverse, | |
| 33 | NXTRegulatedMotor gripper, boolean gripReverse) {
| |
| 34 | turningMotor = turner; | |
| 35 | turnerReversed = turnReverse; | |
| 36 | liftingMotor = lifter; | |
| 37 | lifterReversed = liftReverse; | |
| 38 | grippingMotor = gripper; | |
| 39 | // Assumes gripper starts off in closed position | |
| 40 | grippingMotor.resetTachoCount(); | |
| 41 | } | |
| 42 | ||
| 43 | // Various methods used to control motors (function is obvious form name) | |
| 44 | // The methods are merely wrappers around functions provided by the motor | |
| 45 | // control functions in leJOS | |
| 46 | ||
| 47 | public void turnLeft() {
| |
| 48 | if (turnerReversed) {
| |
| 49 | turningMotor.backward(); | |
| 50 | } else {
| |
| 51 | turningMotor.forward(); | |
| 52 | } | |
| 53 | } | |
| 54 | ||
| 55 | public void turnRight() {
| |
| 56 | if (turnerReversed) {
| |
| 57 | turningMotor.forward(); | |
| 58 | } else {
| |
| 59 | turningMotor.backward(); | |
| 60 | } | |
| 61 | } | |
| 62 | ||
| 63 | public void stopTurning() {
| |
| 64 | turningMotor.stop(); | |
| 65 | } | |
| 66 | ||
| 67 | public void liftUp() {
| |
| 68 | if (lifterReversed) {
| |
| 69 | liftingMotor.forward(); | |
| 70 | } else {
| |
| 71 | liftingMotor.backward(); | |
| 72 | } | |
| 73 | } | |
| 74 | ||
| 75 | public void liftDown() {
| |
| 76 | if (lifterReversed) {
| |
| 77 | liftingMotor.forward(); | |
| 78 | } else {
| |
| 79 | liftingMotor.backward(); | |
| 80 | } | |
| 81 | } | |
| 82 | ||
| 83 | public void stopLifting() {
| |
| 84 | liftingMotor.stop(); | |
| 85 | } | |
| 86 | ||
| 87 | public void openGripper() {
| |
| 88 | // TODO: Still need to calibrate | |
| 89 | grippingMotor.rotateTo(0, true); | |
| 90 | } | |
| 91 | ||
| 92 | public void closeGripper() {
| |
| 93 | // TODO: Still need to calibrate | |
| 94 | grippingMotor.rotateTo(4, true); | |
| 95 | } | |
| 96 | } |