dodany kod c od Krzyska po wielu modyfikacjach przez Gemini zeby usunac zalezność od TI-RTOS
This commit is contained in:
97
src/bin_in.c
Normal file
97
src/bin_in.c
Normal file
@@ -0,0 +1,97 @@
|
||||
/*
|
||||
* bin_in.c
|
||||
*
|
||||
* Created on: 07-04-2014
|
||||
* Author: Krzysztof Jakubczyk
|
||||
*/
|
||||
|
||||
#include "tdefs.h"
|
||||
#include "misc.h"
|
||||
|
||||
#include "bin_in.h"
|
||||
|
||||
int bin_in_initlog(void *arguments, void *logic)
|
||||
{
|
||||
struct bin_in_args *args = (struct bin_in_args *)arguments;
|
||||
struct bin_in_logic *log = (struct bin_in_logic *)logic;
|
||||
|
||||
log->out_ptr = log_manager.nets_data + (args->io.out >> 3);
|
||||
log->out_bit_mask = 1<<(args->io.out & 0x07);
|
||||
log->kob_ptr = log_manager.nets_data + (args->io.kob_out >> 3);
|
||||
log->kob_bit_mask = 1<<(args->io.kob_out & 0x07);
|
||||
|
||||
if(args->params.card_addr>=MAX_BIN_CARDS)
|
||||
{
|
||||
if(args->params.ac_filter)
|
||||
ic->bin_ac_mask_ench[args->params.card_addr-16]|=(1<<args->params.in_num);
|
||||
else
|
||||
ic->bin_ac_mask_ench[args->params.card_addr-16]&=~(1<<args->params.in_num);
|
||||
}
|
||||
else
|
||||
{
|
||||
if(args->params.ac_filter)
|
||||
ic->bin_ac_mask[args->params.card_addr]|=(1<<args->params.in_num);
|
||||
else
|
||||
ic->bin_ac_mask[args->params.card_addr]&=~(1<<args->params.in_num);
|
||||
}
|
||||
|
||||
if(log->out_ptr >= (log_manager.nets_data+sizeof(log_manager.nets_data)))
|
||||
return -1;
|
||||
|
||||
if(log->kob_ptr >= (log_manager.nets_data+sizeof(log_manager.nets_data)))
|
||||
return -1;
|
||||
|
||||
if(args->params.card_addr>=(MAX_BIN_CARDS * 2)) // *2 bo mwd32
|
||||
return -1;
|
||||
|
||||
log->in_num_mask=(1<<args->params.in_num);
|
||||
log->card_addr_mask=(1<<args->params.card_addr);
|
||||
|
||||
if(args->params.card_addr>=16)
|
||||
{
|
||||
mwd32_mask|=1<<(args->params.card_addr&0x07);
|
||||
ic->mwd32_present=1;
|
||||
}
|
||||
|
||||
if(args->params.in_num>=8)
|
||||
return -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void bin_in(void *arguments, void *logic)
|
||||
{
|
||||
struct bin_in_args *args = (struct bin_in_args *)arguments;
|
||||
struct bin_in_logic *log = (struct bin_in_logic *)logic;
|
||||
|
||||
|
||||
if(args->params.card_addr>=MAX_BIN_CARDS) // mwd32
|
||||
{
|
||||
if(bus_bin_data_ench[args->params.card_addr-16] & log->in_num_mask)
|
||||
*log->out_ptr|=log->out_bit_mask;
|
||||
else
|
||||
*log->out_ptr&=~log->out_bit_mask;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(bus_bin_data[args->params.card_addr] & log->in_num_mask)
|
||||
*log->out_ptr|=log->out_bit_mask;
|
||||
else
|
||||
*log->out_ptr&=~log->out_bit_mask;
|
||||
}
|
||||
|
||||
if(mwd32_mask & (1<<(args->params.card_addr&0x07)))
|
||||
{
|
||||
if(ic->kob_bin & (1<<(args->params.card_addr&0x07)))
|
||||
*log->kob_ptr|=log->kob_bit_mask;
|
||||
else
|
||||
*log->kob_ptr&=~log->kob_bit_mask;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(ic->kob_bin & log->card_addr_mask)
|
||||
*log->kob_ptr|=log->kob_bit_mask;
|
||||
else
|
||||
*log->kob_ptr&=~log->kob_bit_mask;
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user