Go to Post ...I pretty much got the impression that the balls are actually very small, cuddly landmines. - Gui Cavalcanti [more]
Home
Go Back   Chief Delphi > Other > FIRST Tech Challenge
CD-Media   CD-Spy  
portal register members calendar search Today's Posts Mark Forums Read FAQ rules

 
 
 
Thread Tools Rate Thread Display Modes
Prev Previous Post   Next Post Next
  #1   Spotlight this post!  
Unread 10-01-2014, 16:07
completelycrazy completelycrazy is offline
Registered User
FTC #6085
 
Join Date: Jan 2014
Location: Ohio
Posts: 2
completelycrazy is an unknown quantity at this point
[FTC]: Problem with RobotC servo code

I'm currently trying to program my team's robot's arm. The arm has two servos. I want each servo to move up or down and then stay in the position it moves to using the d-pad or using the A and B buttons. This is the code I'm using - the part of the code that controls servoWrist works, but the part that controls servoElbow does not. I'm fairly certain it's not a problem with hardware - I've tested three different servos using each section of code and all three work with the servoWrist code, but not with the servoElbow code. I also tried using port three instead of port two for the servoElbow code, but that did not help either, so I believe it's not an issue with the servo controller. I'm currently really confused by this because as far as I can tell, the two sections of code are identical.

Code:
#pragma config(Hubs,  S1, HTMotor,  HTServo,  none,     none)
#pragma config(Sensor, S1,     ,               sensorI2CMuxController)
#pragma config(Motor,  mtr_S1_C1_1,     motorD,        tmotorTetrix, openLoop)
#pragma config(Motor,  mtr_S1_C1_2,     motorE,        tmotorTetrix, openLoop)
#pragma config(Servo,  srvo_S1_C2_1,    servoWrist,           tServoStandard)
#pragma config(Servo,  srvo_S1_C2_2,    servoElbow,           tServoStandard)
#pragma config(Servo,  srvo_S1_C2_3,    servo3,               tServoNone)
#pragma config(Servo,  srvo_S1_C2_4,    servo4,               tServoNone)
#pragma config(Servo,  srvo_S1_C2_5,    servo5,               tServoNone)
#pragma config(Servo,  srvo_S1_C2_6,    servo6,               tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//


#include "JoystickDriver.c"  //Include file to "handle" the Bluetooth messages.
void initializeRobot()
{
  return;
}

task main()
{
  initializeRobot();

  waitForStart();   // wait for start of tele-op phase

  while (true)
  {
   getJoystickSettings(joystick);
		int wristVariable;
 	        int elbowVariable;
		int wristHelp;
		int elbowHelp;

		if(joystick.joy1_TopHat == 4)
		{
			wristVariable = wristHelp;
			wristHelp = wristHelp + 1;
			wait1Msec(10);
		}
		
                if(joystick.joy1_TopHat == 0)
		{
			wristVariable = wristHelp;
			wristHelp = wristHelp - 1;
			wait1Msec(10);
		}

			servo[servoWrist]= wristHelp;

		if(joy1Btn(2))
		{
			elbowVariable = elbowHelp;
			elbowHelp = elbowHelp + 1;
			wait1Msec(10);
		}
		if(joy1Btn(4))
		{
			elbowVariable = elbowHelp;
			elbowHelp = elbowHelp - 1;
			wait1Msec(10);
		}

			servo[servoElbow]= elbowHelp;
  }
}
Reply With Quote
 


Thread Tools
Display Modes Rate This Thread
Rate This Thread:

Posting Rules
You may not post new threads
You may not post replies
You may not post attachments
You may not edit your posts

vB code is On
Smilies are On
[IMG] code is On
HTML code is Off
Forum Jump


All times are GMT -5. The time now is 18:15.

The Chief Delphi Forums are sponsored by Innovation First International, Inc.


Powered by vBulletin® Version 3.6.4
Copyright ©2000 - 2017, Jelsoft Enterprises Ltd.
Copyright © Chief Delphi