Another quick update. After some diversion with Botboarduino Mega Shield and DIY remote code, today I started to play again with the Phoenix code running on Botboarduino JR. Still need to replace the one servo with bad gears, but first problem I ran into was that when I entered into balance mode the robot went nuts. This evening I finally tracked the issue down

The problem was in the lines like:
Code:
BalCalcOneLeg (-LegPosX[LegIndex]+GaitPosX[LegIndex],
LegPosZ[LegIndex]+GaitPosZ[LegIndex],
(LegPosY[LegIndex]-cInitPosY[LegIndex])+GaitPosY[LegIndex], LegIndex);
The problem is that the array cInitPosY is a static array that was moved out of the data space and into the program space. Needed to change the lines to look like:
Code:
BalCalcOneLeg (-LegPosX[LegIndex]+GaitPosX[LegIndex],
LegPosZ[LegIndex]+GaitPosZ[LegIndex],
(LegPosY[LegIndex]-(short)pgm_read_word(&cInitPosY[LegIndex]))+GaitPosY[LegIndex], LegIndex);
So far it appears to be happier... Need to test more. May next try to hook up XBEE. To do some will need to use 2 software serial objects. Should be fun to see how to properly handle the inputs...
Kurt