BOOL getFunctionList(BowlerPacket * Packet){
int chan = Packet->use.data[0];
int index =0;
int i=0;
for(i=0;i<IO_MODE_MAX;i++){
if(pinHasFunction(chan,i)){
Packet->use.data[index++]=i;
}
}
Packet->use.head.DataLegnth=4+index;
FixPacket(Packet);
return TRUE;
}
uint8_t getDefaultMode(uint8_t pin){
if(pin==0){
return IS_DEBUG_RX;
}
if(pin==1){
return IS_DEBUG_TX;
}
int i;
for (i = 0; i < IO_MODE_MAX; i++) {
if (pinHasFunction(pin, i)) {
return i;
}
}
return HIGH_IMPEDANCE;
}
BOOL setMode(BYTE pin,BYTE mode){
println_I("Setting Mode: ");printMode(mode,INFO_PRINT);print_I(" on: ");p_int_I(pin);
BYTE currentMode = GetChannelMode(pin);
ClearCounter(pin);
StopSPI(pin);
clearPPM(pin);
print_I(" \tHardware Cleared");
switch (mode){
case IS_SERVO:
if(((pin < 12) && (isRegulated_0() == 0)) || ((pin >= 12) && (isRegulated_1()== 0)) ){
print_I("|Mode is now servo");
break;
}else{
if(getBrownOutDetect()){
print_I(" Servo Mode could not be set, voltage invalid");
return FALSE;
}else{
print_I(" Servo Mode set|");
break;
}
}
break;
case IS_SPI_MOSI:
case IS_SPI_MISO:
case IS_SPI_SCK:
if( pinHasFunction(pin, mode) != FALSE){
print_I("|Mode is now SPI");
InitSPI();
break;
}else{
return FALSE;
}
break;
case IS_COUNTER_INPUT_INT:
case IS_COUNTER_INPUT_DIR:
case IS_COUNTER_INPUT_HOME:
if(pinHasFunction(pin, mode) != FALSE){
print_I("|Mode is now Counter Input");
StartCounterInput(pin);
break;
}else{
print_I(", Counter Input not availible");
return FALSE;
}
break;
case IS_COUNTER_OUTPUT_INT:
case IS_COUNTER_OUTPUT_DIR:
case IS_COUNTER_OUTPUT_HOME:
if(pinHasFunction(pin, mode) != FALSE){
print_I("|Mode is now Counter Output");
StartCounterOutput(pin);
break;
}else{
print_I(", Counter Output not availible");
return FALSE;
}
break;
case IS_PPM_IN:
println_I("Setting up PPM...");
startPPM(pin);
break;
}
print_I(" \tMode set");
return TRUE;
}
