/*------------------------------------------------------------------------------
--  This file is a part of the SocExplorer Software
--  Copyright (C) 2014, Plasma Physics Laboratory - CNRS
--
--  This program is free software; you can redistribute it and/or modify
--  it under the terms of the GNU General Public License as published by
--  the Free Software Foundation; either version 2 of the License, or
--  (at your option) any later version.
--
--  This program is distributed in the hope that it will be useful,
--  but WITHOUT ANY WARRANTY; without even the implied warranty of
--  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
--  GNU General Public License for more details.
--
--  You should have received a copy of the GNU General Public License
--  along with this program; if not, write to the Free Software
--  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
-------------------------------------------------------------------------------*/
/*--                  Author : Alexis Jeandet
--                     Mail : alexis.jeandet@member.fsf.org
----------------------------------------------------------------------------*/
#include "uartpollingthread.h"
#include <socexplorerengine.h>

UARTPollingThread::UARTPollingThread(socexplorerplugin *parent) :
    QThread((QObject*)parent)
{
    this->plugin = parent;
    uartMutex = new QMutex();
    uartOpened = false;
    fifoDebugConfigured = false;
    this->moveToThread(this);
}

void UARTPollingThread::run()
{

    SocExplorerEngine::message(this->plugin,"Entering APB UART polling thread",3);
    while (!this->isInterruptionRequested())
    {
        if(fifoDebugEnabled)
        {
            if(fifoDebugConfigured)
            {
                if(this->plugin->baseAddress()!=-1)
                {
                    unsigned int status_reg,data;
                    char ch;
                    QString printdata="";
                    plugin->parent->Read(&status_reg,1,this->plugin->baseAddress()+APB_UART_STATUS_REG);
                    while ((status_reg&4)==0) {
                        plugin->parent->Read(&data,1,this->plugin->baseAddress()+APB_UART_FIFO_DEBUG_REG);
                        ch = (char)(0xff & data);
                        printdata+=ch;
                        plugin->parent->Read(&status_reg,1,this->plugin->baseAddress()+APB_UART_STATUS_REG);
                    }
                    if(printdata!="")
                        emit apbUartTextReceived(printdata);
                }
                else
                {
                    this->plugin->setBaseAddress(SocExplorerEngine::self()->getEnumDeviceBaseAddress(this->plugin,this->plugin->VID(),this->plugin->PID(),0));
                }
            }
            else
            {
                configFifoDebug(true);
            }
        }
        else
        {
            int read =0;
            char ch;
            uartMutex->lock();
            if(uartOpened)
            {
                read =rs232read(this->uart,&ch,1);
            }
            uartMutex->unlock();
            if(read==1)
            {
                emit this->sendChar(ch);
            }
        }
        msleep(100);
    }
}

void UARTPollingThread::sendChar(char c)
{
    if(fifoDebugEnabled)
    {
        if(this->plugin->baseAddress()!=-1)
        {
            unsigned int i=0x0FF & c;
            plugin->parent->Write(&i,1,this->plugin->baseAddress()+APB_UART_FIFO_DEBUG_REG);
        }
    }
    else
    {
        uartMutex->lock();
        rs232write(this->uart,&c,1);
        uartMutex->unlock();
    }
}

bool UARTPollingThread::openUart()
{
    if(uartOpened)
    {
        closeUart();
    }
    this->uart = rs232open((char*)this->portName.toStdString().c_str());
    if(this->uart!=badPortValue)
    {
        rs232setup(this->uart,8,this->uartSpeed,rs232parityNo,rs232OneStop);
        uartOpened = true;
    }
    return uartOpened;
}

void UARTPollingThread::closeUart()
{
    uartMutex->lock();
    rs232close(this->uart);
    uartOpened = false;
    uartMutex->unlock();
}

void UARTPollingThread::setPortName(QString name)
{
    this->portName = name;
}

void UARTPollingThread::setPortSpeedStr(QString speed)
{
    this->uartSpeed = speed.toInt();
}

void UARTPollingThread::setPortSpeed(int speed)
{
    this->uartSpeed = speed;
}

void UARTPollingThread::setFifoDebugEable(bool enable)
{
    if(enable)
        SocExplorerEngine::message(this->plugin,"Enabling APB UART FIFO debug mode",3);
    else
        SocExplorerEngine::message(this->plugin,"Disabling APB UART FIFO debug mode",3);
    if(uartOpened && enable)
    {
        closeUart();
    }
    this->fifoDebugConfigured = false;
    configFifoDebug(enable);
    this->fifoDebugEnabled = enable;
}

void UARTPollingThread::configFifoDebug(bool enable)
{
    SocExplorerEngine::message(this->plugin,"Configuring APB UART in FIFO debug mode",3);
    if(this->plugin->baseAddress()==-1)
    {
        this->plugin->setBaseAddress(SocExplorerEngine::self()->getEnumDeviceBaseAddress(this->plugin,this->plugin->VID(),this->plugin->PID(),0));
    }
    if(this->plugin->baseAddress()!=-1)
    {
        if(enable)
        {
            unsigned int ctrl_reg= 0x843;
            this->plugin->parent->Write(&ctrl_reg,1,this->plugin->baseAddress()+APB_UART_CONTROL_REG);
            this->fifoDebugConfigured = true;
        }
        else
        {
            unsigned int ctrl_reg;
            /* Firts get Control reg value*/
            this->plugin->parent->Read(&ctrl_reg,1,this->plugin->baseAddress()+APB_UART_CONTROL_REG);
            ctrl_reg = ctrl_reg & (~(1<<11));
            this->plugin->parent->Write(&ctrl_reg,1,this->plugin->baseAddress()+APB_UART_CONTROL_REG);
            this->fifoDebugConfigured = true;
        }
    }
}