Только вот, что-то у него не клеится всё никак, жалуется, что после включения робота, иногда серва, которая поворачивает камеру, начинает вращаться сама по себе в одну сторону.
Я сам с Arduino никогда дело не имел, так что сам ему помочь не смогу.
Он тут листинг управляющей программы прислал, которую он в Arduino прошивает.
Может кто-нибудь из форумчан сможет помочь разобраться в чёт тут дело?
Эх, очень уж хочется, что бы его трехколесный-бермудский «керогаз» уже поехал куда нужно, что бы и другие пользователи, воодушевлённые его примером, тоже бы подтягивались с установкой AVM Navigator на свои роботы.
Оригинальная тема здесь, а вот текст переписки:
bmw318be писал(а):HI EDV, thanks for the link, It is now installed in RR,
I have a new problem, everytime i plug in the USB to laptop, it keep restarting as the sparkfun also shows high delayed in pipeline, And the servo turret, keep rotating CW until the end and kept forcing the rotation even it is the extreme end, It goes to central after some time and repeated the error, As you can hear the rotation and see in the pipeline
http://youtu.be/fLv8woR4LmA
I had been finding the cause of this error but i was not able, the problems existed inconsistency, sometimes the error dissappear itself after turret errornously move for few times but this time the problem happened nonstop,
I have tried to do the following
1 upload the program to arduino
2. Shutdown the roborealm and plug in the usb to arduino
3.disactivate the turret
What happen
1. Problem still exist
2when shutdown, the error solved, when plug jn the usb to arduino and in the sparkfun assign the port, the problem exist
3. Worked but when activate again, problem exist
Other observation: when the robot is powered with the batterry on. The robot move by itself and turret keep going clockwise non stop repeatedly
EDV писал(а):You should specify some additional information regarding your Arduino controller so that we will be able to help with it:
1. What Arduino firmware version you use?
2. Which ports you use for servos connection?
3. How was implemented power supply of Arduino controller.
Please try to provide for us more detailed information for analysis.
bmw318be писал(а):1 i am using arduino 0022
2 servo turret connection pin 9 and the port that i use is port 7
3. The power of the arduino is using batterry 12 V. And since the usb is connected the power 1st is through USB.
That is why we see the pipeline has high value and once i on the power in batterry, the robot sometimes moved by itself when it is im error stage
Is it info above sufficient
EDV писал(а):The number 00022 is version of IDE that you use but we need in firmware program version number that you have uploaded/burned to Arduino controller.
If you use your own user-made arduino program then you should give us source code for analyses.
If you use already-made arduino program then you should give us link to the project where you have downloaded this firmware arduino program.
bmw318be писал(а):Here is the code, Note:L the ultrasonic sensor, I did not use it, Hope you can have a good analysis
program.robo
I think thats is the RR code, here is the arduino code:
- Код: Выделить всё • Развернуть
ervo servos[12];
boolean pinModes[14];
unsigned int crc;
unsigned int command;
unsigned int channel;
unsigned int value;
unsigned int valueLow;
unsigned int valueHigh;
unsigned int streamDigital;
unsigned int streamAnalog;
unsigned int lastDigital;
unsigned int lastAnalog[8];
#define ARDUINO_GET_ID 0
#define ARDUINO_SET_SERVO 1
#define ARDUINO_SET_DIGITAL_STREAM 2
#define ARDUINO_SET_DIGITAL_HIGH 3
#define ARDUINO_SET_DIGITAL_LOW 4
#define ARDUINO_SET_ANALOG_STREAM 5
#define ARDUINO_DIGITAL_STREAM 6
#define ARDUINO_ANALOG_STREAM 7
#define ARDUINO_SET_ANALOG 8
void initializeAvmNav()
{
int i;
for (i=2;i<14;i++) pinModes[i]=-1;
streamDigital=0;
streamAnalog=0;
lastDigital=-1;
for (i=0;i<8;i++) lastAnalog[i]=-1;
}
void writePacketAvmNav()
{
unsigned char buffer[2];
buffer[0]=command|128;
buffer[1]=channel;
Serial.write(buffer, 2);
}
void writeValuePacketAvmNav(int value)
{
unsigned char buffer[5];
buffer[0]=command|128;
buffer[1]=channel;
buffer[2]=value&127;
buffer[3]=(value>>7)&127;
buffer[4]=(buffer[0]^buffer[1]^buffer[2]^buffer[3])&127;
Serial.write(buffer, 5);
}
void readPacketAvmNav()
{
// get header byte
// 128 (bit 8) flag indicates a new command packet .. that
// means the value bytes can never have 128 set!
// next byte is the command 0-8
// next byte is the channel 0-16
do
{
while (Serial.available() <= 0) continue;
command = Serial.read();
}
while ((command&128)==0);
command^=128;
while (Serial.available() <= 0) continue;
channel = Serial.read();
}
int readValuePacketAvmNav()
{
unsigned int valueLow;
unsigned int valueHigh;
// wait for value low byte
while (Serial.available() <= 0) continue;
valueLow = Serial.read();
if (valueLow&128) return 0;
// wait for value high byte
while (Serial.available() <= 0) continue;
valueHigh = Serial.read();
if (valueHigh&128) return 0;
// wait for crc byte
while (Serial.available() <= 0) continue;
crc = Serial.read();
if (crc&128) return 0;
if (crc!=(((128|command)^channel^valueLow^valueHigh)&127)) return 0;
value = valueLow|(valueHigh<<7);
return 1;
}
/***************************************************************
Part : Ultrasound signal sensor functions for range-finder
***************************************************************/
int ultraSoundSignal = 9;
//Get the distance
float distCalc() // distance calculating function converts analog input to inches
{
pinMode(ultraSoundSignal, OUTPUT); // Switch signalpin to output
digitalWrite(ultraSoundSignal, LOW); // Send low pulse
delayMicroseconds(2); // Wait for 2 microseconds
digitalWrite(ultraSoundSignal, HIGH); // Send high pulse
delayMicroseconds(5); // Wait for 5 microseconds
digitalWrite(ultraSoundSignal, LOW); // Holdoff
pinMode(ultraSoundSignal, INPUT); // Switch signalpin to input
digitalWrite(ultraSoundSignal, HIGH); // Turn on pullup resistor
unsigned long echo = pulseIn(ultraSoundSignal, HIGH); //Listen for echo
//convert to CM then to inches
return ((echo / 58.138) * 0.39 *2.2);
}
/***************************************************************
Part : Main Arduino functions
***************************************************************/
void setup()
{
//setup communication with roborealm PC
Serial.begin(115200);
initializeAvmNav();
//setup for ultraSoundSignal
//pinMode(ultraSoundSignal, OUTPUT); // sets enable as output
}
void loop()
{
//distCalc();
//delay(40);
while (Serial.available()>0)
{
readPacketAvmNav();
switch (command)
{
// init
case ARDUINO_GET_ID:
initializeAvmNav();
Serial.print("ARDU");
break;
// servo
case ARDUINO_SET_SERVO:
if ((channel>=3)&&(channel<=11))
{
if (readValuePacketAvmNav())
{
if (pinModes[channel]!=1)
{
servos[channel].attach(channel);
pinModes[channel]=1;
}
servos[channel].writeMicroseconds(value);
writeValuePacketAvmNav(value);
}
}
break;
//digital stream
case ARDUINO_SET_DIGITAL_STREAM:
if (readValuePacketAvmNav())
{
streamDigital = value;
writeValuePacketAvmNav(value);
lastDigital=-1;
}
break;
//set digital high
case ARDUINO_SET_DIGITAL_HIGH:
if ((channel>=2)&&(channel<14))
{
if (pinModes[channel]!=2)
{
if (pinModes[channel]==1)
servos[channel].detach();
pinMode(channel, OUTPUT);
pinModes[channel]=2;
if (streamDigital&(1<<channel))
streamDigital^=1<<channel;
}
digitalWrite(channel, HIGH);
writePacketAvmNav();
}
break;
//set digital low
case ARDUINO_SET_DIGITAL_LOW:
if ((channel>=2)&&(channel<14))
{
if (pinModes[channel]!=2)
{
if (pinModes[channel]==1)
servos[channel].detach();
pinMode(channel, OUTPUT);
pinModes[channel]=2;
if (streamDigital&(1<<channel))
streamDigital^=1<<channel;
}
digitalWrite(channel, LOW);
writePacketAvmNav();
}
break;
//analog stream
case ARDUINO_SET_ANALOG_STREAM:
if (readValuePacketAvmNav())
{
streamAnalog = value;
writeValuePacketAvmNav(value);
for (channel=0;channel<8;channel++) lastAnalog[channel]=-1;
}
break;
case ARDUINO_SET_ANALOG:
if (readValuePacketAvmNav())
{
if ((channel>=3)&&(channel<=11))
{
if (pinModes[channel]!=2)
{
if (pinModes[channel]==1)
servos[channel].detach();
pinMode(channel, OUTPUT);
pinModes[channel]=2;
}
analogWrite(channel, value);
writeValuePacketAvmNav(value);
}
}
break;
}
}
for (channel=0;channel<8;channel++)
{
if (streamAnalog&(1<<channel))
{
value = analogRead(channel);
// only send value if it has changed
if (value!=lastAnalog[channel])
{
command = ARDUINO_ANALOG_STREAM;
writeValuePacketAvmNav(value);
lastAnalog[channel]=value;
}
}
}
if (streamDigital)
{
value=0;
for (channel=2;channel<14;channel++)
{
if (streamDigital&(1<<channel))
{
if (pinModes[channel]!=3)
{
if (pinModes[channel]==1)
servos[channel].detach();
pinMode(channel, INPUT);
pinModes[channel]=3;
// pullup
digitalWrite(channel, HIGH);
}
value |= digitalRead(channel)<<channel;
}
}
// only send value if it has changed
if (value!=lastDigital)
{
command = ARDUINO_DIGITAL_STREAM;
writeValuePacketAvmNav(value);
lastDigital=value;
}
}
}
