53 lines
1.2 KiB
C
53 lines
1.2 KiB
C
/*
|
|
* nor.c
|
|
*
|
|
* Created on: 29-04-2014
|
|
* Author: KJ
|
|
*/
|
|
|
|
|
|
#include "tdefs.h"
|
|
#include "misc.h"
|
|
|
|
#include "nor.h"
|
|
|
|
int nor_initlog(void *arguments, void *logic)
|
|
{
|
|
struct nor_args *args = (struct nor_args *)arguments;
|
|
struct nor_logic *log = (struct nor_logic *)logic;
|
|
|
|
log->out_ptr = log_manager.nets_data + (args->io.out >> 3);
|
|
log->out_bit_no = args->io.out & 0x07;
|
|
|
|
log->in1_ptr = log_manager.nets_data + (args->io.in1 >> 3);
|
|
log->in1_bit_no = args->io.in1 & 0x07;
|
|
|
|
log->in2_ptr = log_manager.nets_data + (args->io.in2 >> 3);
|
|
log->in2_bit_no = args->io.in2 & 0x07;
|
|
|
|
if(log->out_ptr >= (log_manager.nets_data+sizeof(log_manager.nets_data)))
|
|
return -1;
|
|
|
|
if(log->in1_ptr >= (log_manager.nets_data+sizeof(log_manager.nets_data)))
|
|
return -1;
|
|
|
|
if(log->in2_ptr >= (log_manager.nets_data+sizeof(log_manager.nets_data)))
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void nor(void *arguments, void *logic)
|
|
{
|
|
struct nor_args *args = (struct nor_args *)arguments;
|
|
struct nor_logic *log = (struct nor_logic *)logic;
|
|
|
|
if(args->io.out)
|
|
{
|
|
if(!( (*log->in1_ptr & (1<<log->in1_bit_no)) || (*log->in2_ptr & (1<<log->in2_bit_no)) ))
|
|
*log->out_ptr|=(1<<log->out_bit_no);
|
|
else
|
|
*log->out_ptr&=~(1<<log->out_bit_no);
|
|
}
|
|
}
|