|
chuckmerja
Rookie
Joined: Sat Oct 25, 2008 12:18 am Posts: 18
|
 adding motor control problems
We had some cute driving code that allows us to drive (motorD and E) in either direction as if we were driving forward with just the touch and holding of a button - that is drive normally in one case, and when the button is pressed and held we drive in the opposite direction as if it were forward. PROBLEM - we have tried to add the control of other motors (motorF) and are having problems - the code compiles then the new motor runs without control, and there is no control of the driving motors. We've put the new motor code into Suggestions? ===CODE=== #pragma config(Hubs, S1, HTMotor, HTMotor, none, none) #pragma config(Motor, mtr_S1_C1_1, motorD, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C1_2, motorE, tmotorNormal, openLoop, reversed) #pragma config(Motor, mtr_S1_C2_1, motorF, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C2_2, , tmotorNone, openLoop) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
///////////////////////////////////////////////////////////////////////////////////////////////////// // // Tele-Operation Mode Code Template // // This file contains a template for simplified creation of an tele-op program for an FTC // competition. // // You need to customize two functions with code unique to your specific robot. // /////////////////////////////////////////////////////////////////////////////////////////////////////
#include "JoystickDriver.c" //Include file to "handle" the Bluetooth messages.
///////////////////////////////////////////////////////////////////////////////////////////////////// // // initializeRobot // // Prior to the start of tele-op mode, you may want to perform some initialization on your robot // and the variables within your program. // // In most cases, you may not have to add any code to this function and it will remain "empty". // /////////////////////////////////////////////////////////////////////////////////////////////////////
void initializeRobot() { // Place code here to sinitialize servos to starting positions. // Sensors are automatically configured and setup by ROBOTC. They may need a brief time to stabilize.
return; }
///////////////////////////////////////////////////////////////////////////////////////////////////// // // Main Task // // The following is the main code for the tele-op robot operation. Customize as appropriate for // your specific robot. // // Game controller / joystick information is sent periodically (about every 50 milliseconds) from // the FMS (Field Management System) to the robot. Most tele-op programs will follow the following // logic: // 1. Loop forever repeating the following actions: // 2. Get the latest game controller / joystick settings that have been received from the PC. // 3. Perform appropriate actions based on the joystick + buttons settings. This is usually a // simple action: // * Joystick values are usually directly translated into power levels for a motor or // position of a servo. // * Buttons are usually used to start/stop a motor or cause a servo to move to a specific // position. // 4. Repeat the loop. // // Your program needs to continuously loop because you need to continuously respond to changes in // the game controller settings. // // At the end of the tele-op period, the FMS will autonmatically abort (stop) execution of the program. // /////////////////////////////////////////////////////////////////////////////////////////////////////
task main() { while (true) { getJoystickSettings(joystick); //Update Buttons and Joysticks
if(joy1Btn(8) != 0) //If Joy1-Button1 is pressed { motor[motorD] = joystick.joy1_y1; motor[motorE] = joystick.joy1_y2; // Run in reverse, but steering not reversed. if(joy2Btn(5) != 0) { motor[motorF] = 128; // Run the loader } else { motor[motorF] = 0 } } else //If Joy1-Button1 is NOT pressed { motor[motorD] = -joystick.joy1_y2; motor[motorE] = -joystick.joy1_y1; // Run as "normal" if(joy2Btn(5) != 0) { motor[motorF] = 128; // Run the loader } } } }
======another attempt==============
#pragma config(Hubs, S1, HTMotor, HTMotor, none, none) #pragma config(Motor, mtr_S1_C1_1, motorD, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C1_2, motorE, tmotorNormal, openLoop, reversed) #pragma config(Motor, mtr_S1_C2_1, motorF, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C2_2, , tmotorNone, openLoop) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
///////////////////////////////////////////////////////////////////////////////////////////////////// // // Tele-Operation Mode Code Template // // This file contains a template for simplified creation of an tele-op program for an FTC // competition. // // You need to customize two functions with code unique to your specific robot. // /////////////////////////////////////////////////////////////////////////////////////////////////////
#include "JoystickDriver.c" //Include file to "handle" the Bluetooth messages.
///////////////////////////////////////////////////////////////////////////////////////////////////// // // initializeRobot // // Prior to the start of tele-op mode, you may want to perform some initialization on your robot // and the variables within your program. // // In most cases, you may not have to add any code to this function and it will remain "empty". // /////////////////////////////////////////////////////////////////////////////////////////////////////
void initializeRobot() { // Place code here to sinitialize servos to starting positions. // Sensors are automatically configured and setup by ROBOTC. They may need a brief time to stabilize.
return; }
///////////////////////////////////////////////////////////////////////////////////////////////////// // // Main Task // // The following is the main code for the tele-op robot operation. Customize as appropriate for // your specific robot. // // Game controller / joystick information is sent periodically (about every 50 milliseconds) from // the FMS (Field Management System) to the robot. Most tele-op programs will follow the following // logic: // 1. Loop forever repeating the following actions: // 2. Get the latest game controller / joystick settings that have been received from the PC. // 3. Perform appropriate actions based on the joystick + buttons settings. This is usually a // simple action: // * Joystick values are usually directly translated into power levels for a motor or // position of a servo. // * Buttons are usually used to start/stop a motor or cause a servo to move to a specific // position. // 4. Repeat the loop. // // Your program needs to continuously loop because you need to continuously respond to changes in // the game controller settings. // // At the end of the tele-op period, the FMS will autonmatically abort (stop) execution of the program. // /////////////////////////////////////////////////////////////////////////////////////////////////////
task main() { while (true) { getJoystickSettings(joystick); //Update Buttons and Joysticks
if(joy1Btn(8) != 0) //If Joy1-Button1 is pressed { motor[motorD] = joystick.joy1_y1; motor[motorE] = joystick.joy1_y2; // Run in reverse, but steering not reversed. } else //If Joy1-Button1 is NOT pressed { motor[motorD] = -joystick.joy1_y2; motor[motorE] = -joystick.joy1_y1; // Run as "normal" } if(joy2Btn(5) != 0) // Run the loader { motor[motorF] = 128; } } }
|