/* 
 * File:   pin.tpp
 * Author: naopross
 * 
 * Created on May 3, 2018, 8:02 PM
 */

#ifndef PIN_TPP
#define PIN_TPP
#include "pin.hpp"


template<unsigned bit>
template<typename latch_T, typename tris_T, typename port_T>
io_pin<bit>::io_pin(latch_T *latch, tris_T *tris, port_T *port) :
    _latch(reinterpret_cast<volatile uint8_t *>(latch)),
    _tris(reinterpret_cast<volatile uint8_t *>(tris)),
    _port(reinterpret_cast<volatile uint8_t *>(port))
{
    // default settings
    set_mode(io_pin<bit>::mode::OUTPUT);
    set(io_pin<bit>::state::OFF);
}


template<unsigned bit>
io_pin<bit>::~io_pin()
{
    
}


template<unsigned bit>
void io_pin<bit>::set_mode(unsigned m)
{
    if (m)
        *_tris |= 1<<bit; // input
    else
        *_tris &= ~(1<<bit); // output
}

template<unsigned bit>
void io_pin<bit>::set_mode(io_pin<bit>::mode m)
{
    set_mode(static_cast<unsigned>(m));
}

template<unsigned bit>
unsigned io_pin<bit>::read() const
{
    return (*_port & (1<<bit)) ? 1 : 0;
}

template<unsigned bit>
unsigned io_pin<bit>::is_set() const
{
    return (*_latch & (1<<bit)) ? 1 : 0;
}

template<unsigned bit>
void io_pin<bit>::set(unsigned s)
{
    if (s > 0)
        *_latch |= 1<<bit; // on
    else
        *_latch &= ~(1<<bit); // off
}

template<unsigned bit>
void io_pin<bit>::set(io_pin<bit>::state s)
{
    set(static_cast<unsigned>(s));
}

template<unsigned bit>
void io_pin<bit>::toggle()
{
    *_latch ^= 1<<bit;
}

template<unsigned bit>
bool io_pin<bit>::operator==(const io_pin<bit> &other) const
{
    return (_latch == other._latch 
        && _tris == other._tris 
        && _port == other._port);
}

template<unsigned bit>
bool io_pin<bit>::operator!=(const io_pin<bit> &other) const
{
    return !(*this == other);
}

#endif