RoboSavvy Forum

Driving an RCB4

2011-11-28T13:39:32+01:00

Yeah, I saw this, this is where I got all the init byte codes from for comtolling a specific servo, you also only need to specify the servos that are active but these init must be sent for the RCB4 to talk to the servos.

The lack of init for configuring which servos are enabled is a limitation of libkondo4 and I'll add it to my todo list.

In general though, if the configuration is saved to ROM in HTH4, then there should be no problems either commanding the servos or running motions right after startup. We know about this especially because if we lose power or swap batteries in our robot, we definitely don't want to have to re-initialize (or signal our software to re-init) in order to keep moving.

Is this available in English? All the documents I found were in Japanese, and so not really any use. Although I found it pretty straight forward to reverse engineer HtH4 once I knew the stucture of the codes.

Google translate worked perfectly on it. But yeah, libkondo4 also came out of reverse engineering HTH4, before the documentation was available.

This on your github? I've put all my code on my bitbucket page if you want to take a look.

Yeah it's on my bitbucket. It uses the linux serial stuff e.g. /dev/tty*

Thanks for your contributions

Statistics: Posted by chrisvo — Mon Nov 28, 2011 1:39 pm

RCB4 Access

2011-11-28T12:39:35+01:00

Hi Chris,

but it's all saved to ROM so that you can power it up and use the remote control as intended by Kondo

Yeah, I saw this, this is where I got all the init byte codes from for comtolling a specific servo, you also only need to specify the servos that are active but these init must be sent for the RCB4 to talk to the servos.

the manual with all memory addresses and commands and their meanings is available from Kondo directly on their web site.

Is this available in English? All the documents I found were in Japanese, and so not really any use. Although I found it pretty straight forward to reverse engineer HtH4 once I knew the stucture of the codes.

example code is included for addressing the COM port directly

This on your github? I've put all my code on my bitbucket page if you want to take a look.

Thanks muchly,

John

Statistics: Posted by keukpa — Mon Nov 28, 2011 12:39 pm

Driving an RCB4

2011-11-28T11:46:38+01:00

The RCB4 needs to know which servos are active and their address on the bus, but it's all saved to ROM so that you can power it up and use the remote control as intended by Kondo.

You don't need to reverse engineer Heart2Heart4 anymore by the way, the manual with all memory addresses and commands and their meanings is available from Kondo directly on their web site.

Libkondo4 also mentions in the docs that you do not need the ftdi header, example code is included for addressing the COM port directly.

Statistics: Posted by chrisvo — Mon Nov 28, 2011 11:46 am

Sucess

2011-10-28T22:49:22+01:00

amuthelet,

No, that code does not work for me either!

I do not see how libkondo4 can even work, it misses out a LOT of servo, EEPROM and RCB4 initialisation. Unless I'm missing some command here (and please tell me if I am), I fail to see how it works.

When you run Heart2Heart 4, before you can even contemplate moving the servos, you have to click the RAM button. This initialises all the servos and the RCB4 board by telling the board, exactly which servos are active, and their address on the bus. libkondo4 doesn't seem to do this.

Myself and a colleague have spent the past week reverse engineering the HeartToHeart4 program, and we now have a fully working program that can easily drive any servo on any SIO# we choose. We can even do this without the need for the ftdi header. You just address the com port directly (windows and linux).

Thanks for all the support you guys have provided tho. But now we've sorted the byte codes out, it is surprisingly easy to control these servos.

Cheers,

Keukpa

Statistics: Posted by keukpa — Fri Oct 28, 2011 10:49 pm

Driving an RCB4

2011-10-27T23:28:35+01:00

Statistics: Posted by amuthelet — Thu Oct 27, 2011 11:28 pm

Driving an RCB4

2011-10-27T23:23:53+01:00

Hello Keupka,

Did you double check your baud rate ? Most problems I had with libkondo where related to erroneous baud rates. You may want to check that RCB4_BAUD is set to the same value as the one you defined inside HeartToHeart:

#define RCB4_BAUD 1250000 (or else)

By the way, here is a (not very optimized) function I added to libkondo to send servo pos by servo ID:

int kondo_set_servo_pos(KondoRef ki, UINT servo_id, UINT frame)
{
assert(ki);

// init array
UCHAR servos[5];
int no;
for(no=0; no<5; no++)
servos[no] = 0b0000000;

div_t divresult;
divresult = div (servo_id,8);
servos[4 - divresult.quot] = 0b00000001 << divresult.rem;

return kondo_send_ics_pos(ki, servos, frame);

}

Servo IDs being as shown in the attached picture.

Hope this can help,
Cheers,
Arnaud.

Statistics: Posted by amuthelet — Thu Oct 27, 2011 11:23 pm

Green LED

2011-10-26T13:23:19+01:00

Ok, I've managed to write a function to switch the green LED on and Off and this works perfectly.

I did this by constructing a swap[] with the following data:

09 00 02 00 00 1F 80 AA

and sending this directly to the board via kondo_trx(...)

I've noticed that when using the HeartToHeart4 program before you can move any Servos you need to click on the 'RAM' button, which then according to the console output sends LOADS of data to the board, it sends 34 lines of a particular byte code which I assume inits the servos in some way??

So my question is thus, with libkondo4, before I can move the servos, do I not need to first init the servos and the board in the same way the RAM button on the HeartToHeart4 program does? kondo_init() seems to just init the serial comms to the RCB4 not actually inform the EEPROM where the servos are, etc.....

Cheers,

Keukpa

Statistics: Posted by keukpa — Wed Oct 26, 2011 1:23 pm

Driving an RCB4

2011-10-25T21:45:23+01:00

You wouldn't happen to have a pre-compiled binary for Linux I could try would you? If that works I can then at least rule out system problems!

Statistics: Posted by keukpa — Tue Oct 25, 2011 9:45 pm

Driving an RCB4

2011-10-25T16:53:42+01:00

thank you, here is my program. This is residing in the /util directory and I use make to build it.

#include "rcb4.h"
#include

KondoInstance ki;

int main(int argc, char *argv[])
{
// cmd line arguments ----------------------------

if (argc < 2) {
fprintf(stderr, "Usage: zero_pos position\n");
exit(1);
}

// open ------------------------------------------

int ret = kondo_init(&ki);
if (ret < 0) {
printf("%s", ki.error);
exit(-1);
}
ki.debug = 1;

// servo set (ALL)
unsigned char servos[] = { ~0, ~0, ~0, ~0, ~0 };

unsigned int command = 32767;

//send the command
ret = kondo_send_ics_pos(&ki, servos, command);
if (ret < 0) {
printf("%s", ki.error);
exit(-1);
}

unsigned int command1 = atoi(argv[1]);
ret = kondo_send_ics_pos(&ki, servos, command1);
if (ret < 0) {
printf("%s", ki.error);
exit(-1);
}

// close -----------------------------------------
ret = kondo_close(&ki);
if (ret < 0) {
printf("%s", ki.error);
exit(-1);
}
return 0;
}

Statistics: Posted by keukpa — Tue Oct 25, 2011 4:53 pm

Driving an RCB4

2011-10-25T16:42:28+01:00

wow, can you send me your code? I have never seen something like that.

Statistics: Posted by chrisvo — Tue Oct 25, 2011 4:42 pm

response not valid

2011-10-25T16:15:10+01:00

Hi Chrisvo,

I've put back in error checking and now get the following output:

[keukpa@localhost utils]$ sudo ./zero_pos 2
50, 255
send 89 bytes: 59 10 ff ff ff ff ff 1 ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f ff 7f 15
recv 4 bytes: 4 10 6 1a
ERROR: kondo_send_ics_pos: Response was not valid

Any ideas?

Many thanks,

Keukpa

Statistics: Posted by keukpa — Tue Oct 25, 2011 4:15 pm

Driving an RCB4

2011-10-25T16:01:51+01:00

libkondo4 will return error codes in its functions to indicate what's wrong. my example code in this thread skips checking for error codes, but you can take a look at the samples in the utils/ folder for how to check for errors and maybe that will tell you something. For example, if there was an error communicating over the FTDI then it would usually tell you specifically what in the FTDI library had a problem, and which kondo (libkondo4) function caused it.

Statistics: Posted by chrisvo — Tue Oct 25, 2011 4:01 pm

Driving an RCB4

2011-10-25T15:53:45+01:00

hmmm that is strange!

Thank you for your help and suggestions.

Could it be my version of Linux or the linux ftdi / usb libs?

Cheers,

Keukpa

Statistics: Posted by keukpa — Tue Oct 25, 2011 3:53 pm

Driving an RCB4

2011-10-25T15:48:11+01:00

I'm not sure. That code works fine using my RCB4 and servos...

Statistics: Posted by chrisvo — Tue Oct 25, 2011 3:48 pm

Driving an RCB4

2011-10-25T15:37:18+01:00

Hi, yes I have tried the board and servos with Heart2Heart4 and it all works fine.

Below is my code, however I still can not get the servo to move!

#include "rcb4.h"
#include

KondoInstance ki;

int main(int argc, char *argv[])
{
// cmd line arguments ----------------------------

// open ------------------------------------------

kondo_init(&ki);

// servo set (ALL)
unsigned char servos[] = { ~0, ~0, ~0, ~0, ~0 };

printf("%d, %d\n", *argv[1], servos[0]);

unsigned int command = 32767;

//send the command
kondo_send_ics_pos(&ki, servos, command);

unsigned int command1 = 1000;
kondo_send_ics_pos(&ki, servos, command1);

// close -----------------------------------------
kondo_close(&ki);
}

Statistics: Posted by keukpa — Tue Oct 25, 2011 3:37 pm