Mod_channel_case_2ch

This commit is contained in:
hchen3
2020-03-28 09:50:56 +08:00
parent 2610a9e00e
commit 7e2b3cee98
@@ -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];