Mod_channel_case_2ch
This commit is contained in:
+23
-31
@@ -911,51 +911,43 @@ static void headstage_uni_umc_data_append_notify_buffer(uint8_t* dat_buf) {
|
||||
pramb = 0;
|
||||
channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer]];
|
||||
break;
|
||||
//case 2:
|
||||
//if (INSTRUCTION.channel_mux[channel_pointer]==INSTRUCTION.last_enable_channel){
|
||||
// pramb=1;
|
||||
//}
|
||||
//else {
|
||||
// pramb=0;
|
||||
//}
|
||||
//if ((dat_buf[0] & 0xC1) == 0xC1) {
|
||||
// channel = reverse_channel[INSTRUCTION.last_enable_channel];
|
||||
//}
|
||||
//else if (dat_buf[0] == 0) {
|
||||
//else {
|
||||
// channel = reverse_channel[INSTRUCTION.channel_mux[INSTRUCTION.last_enable_channel-1]];
|
||||
//}
|
||||
//else {
|
||||
// channel = reverse_channel[13];
|
||||
//headstage_led_spi_color(COLOR_RED);
|
||||
//}
|
||||
//break;
|
||||
case 2:
|
||||
if ((dat_buf[0] & 0xC1) == 0xC1) {
|
||||
channel = reverse_channel[INSTRUCTION.last_enable_channel];
|
||||
}
|
||||
//else if (dat_buf[0] == 0 && pramb == 0) {}
|
||||
else{
|
||||
if(channel_pointer==0 && INSTRUCTION.channel_mux[channel_pointer]==INSTRUCTION.last_enable_channel)
|
||||
{channel_pointer++;}
|
||||
|
||||
if ((INSTRUCTION.last_enable_channel%2) == 0)
|
||||
if (channel_pointer == INSTRUCTION.last_enable_channel)
|
||||
{channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer - 1]]}
|
||||
else
|
||||
{channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer + 1]];}
|
||||
else
|
||||
{channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer]];}
|
||||
}
|
||||
channel_pointer++;
|
||||
INSTRUCTION.channel_pointer = channel_pointer % (INSTRUCTION.last_enable_channel+1);
|
||||
break;
|
||||
default: // for enable_channel_num >2
|
||||
//expectation on preamble
|
||||
if (INSTRUCTION.channel_mux[channel_pointer] == INSTRUCTION.last_enable_channel){
|
||||
pramb=1;
|
||||
// if ((dat_buf[0] & 0xF0) == 0x00){
|
||||
// channel_pointer++;
|
||||
// pramb=0;}
|
||||
}
|
||||
else {
|
||||
pramb=0;
|
||||
}
|
||||
|
||||
//check whether the preamble appear as expected. If not, channel = 255
|
||||
//the check for preamble could be refined to be more sophisticate
|
||||
if ((dat_buf[0] & 0xC1) == 0xC1) {
|
||||
channel = reverse_channel[INSTRUCTION.last_enable_channel];
|
||||
}
|
||||
//else if (dat_buf[0] == 0 && pramb == 0) {}
|
||||
else{
|
||||
if(channel_pointer==0 && INSTRUCTION.enable_channel_number==2 && INSTRUCTION.channel_mux[channel_pointer]==INSTRUCTION.last_enable_channel)
|
||||
{channel_pointer++;}
|
||||
if(channel_pointer==0 && INSTRUCTION.channel_mux[channel_pointer]==INSTRUCTION.last_enable_channel)
|
||||
{channel_pointer++;}
|
||||
|
||||
if (INSTRUCTION.enable_channel_number==2 && ((INSTRUCTION.last_enable_channel%2) == 0))
|
||||
{channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer+1]];}
|
||||
else
|
||||
{channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer]];}
|
||||
channel = reverse_channel[INSTRUCTION.channel_mux[channel_pointer]];
|
||||
}
|
||||
//else {
|
||||
// channel = reverse_channel[13];
|
||||
|
||||
Reference in New Issue
Block a user