21 lines
656 B
C++
21 lines
656 B
C++
#include "writepin.h"
|
|
|
|
void writePin(volatile unsigned char * const port, const unsigned char pin, const bool state)
|
|
{
|
|
*port = (*port & ~(1 << pin)) | (1 << pin)*state;
|
|
//if(!state) *port &= ~(1 << pin);
|
|
//else *port |= (1 << pin);
|
|
}
|
|
|
|
void setBit( volatile unsigned char * const reg, const unsigned char bit, const bool value )
|
|
{
|
|
writePin(reg, bit, value);
|
|
}
|
|
|
|
void setDirection( volatile unsigned char * const portDirReg, const unsigned char pin, const bool makeOutput )
|
|
{
|
|
writePin(portDirReg, pin, makeOutput);
|
|
}
|
|
|
|
bool readPin( volatile const unsigned char * const inPort, const unsigned char pin){ return (bool) (*inPort & (1 << pin));}
|