OpenRTX/lib/miosix-kernel/miosix/kernel/IRQDisplayPrint.cpp

/***************************************************************************
 *   Copyright (C) 2016 by Lorenzo Pinosa                                  *
 *                                                                         *
 *   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.                          *
 *                                                                         *
 *   As a special exception, if other files instantiate templates or use   *
 *   macros or inline functions from this file, or you compile this file   *
 *   and link it with other works to produce a work based on this file,    *
 *   this file does not by itself cause the resulting work to be covered   *
 *   by the GNU General Public License. However the source code for this   *
 *   file must still be made available in accordance with the GNU General  *
 *   Public License. This exception does not invalidate any other reasons  *
 *   why a work based on this file might be covered by the GNU General     *
 *   Public License.                                                       *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this program; if not, see <http://www.gnu.org/licenses/>   *
 ***************************************************************************/

#include "IRQDisplayPrint.h"
#include "string"
#include "display.h"
#include <memory>

using namespace std;
using namespace mxgui;

namespace miosix {

IRQDisplayPrint::IRQDisplayPrint()
    : Device(TTY), right_margin(5), bottom_margin(5),
      carriage_return_enabled(false)
{
}

IRQDisplayPrint::~IRQDisplayPrint() {}

void IRQDisplayPrint::IRQwrite(const char * to_print)
{
    string str = to_print;
    input_queue.put(str);
}

ssize_t IRQDisplayPrint::writeBlock(const void * buffer, size_t size, off_t where)
{
    string str = reinterpret_cast<const char*>(buffer);
    str = str.substr(where, size);
    input_queue.put(str);
    return size;
}

void IRQDisplayPrint::printIRQ()
{
    while (true)
    {
        string tmp;
        input_queue.get(tmp);
        if (tmp.size() == 0)
            continue;
        if (carriage_return_fix(tmp))
            continue;
        process_string(tmp);
        check_array_overflow();
        internal_print();
    }
}

//returns true if the current string has to be discarded
bool IRQDisplayPrint::carriage_return_fix(string str)
{
    if (!carriage_return_enabled && str.compare("\r\n") == 0)
    {
        carriage_return_enabled = true;
        return true;
    }
    if (str.compare("\r\n") == 0)
    {
        return false;
    }
    else
    {
        carriage_return_enabled = false;
        return false;
    }
}

void IRQDisplayPrint::check_array_overflow()
{
    int font_height, display_h;
    {
        DrawingContext dc(Display::instance());
        font_height = dc.getFont().getHeight();
        display_h = dc.getHeight();
    }
    while (font_height * print_lines.size() >= display_h - bottom_margin)
    {
        print_lines.erase(print_lines.begin());
    }
}

void IRQDisplayPrint::process_string(string str)
{
    int display_w;
    auto_ptr<Font> font;
    {
        DrawingContext dc(Display::instance());
        display_w = dc.getWidth();
        font = auto_ptr<Font>(new Font(dc.getFont()));
    }

    vector<string> lines;
    while (str.length() > 0)
    {
        int lenght = font->calculateLength(str.c_str());
        if (lenght < display_w)
        {
            lines.push_back(str);
            break;
        }
        //else
        int len = 0;
        string str_part;
        for (int i = 1; len < display_w - right_margin; i++)
        {
            str_part = str.substr(0, i);
            len = font->calculateLength(str_part.c_str());
        }
        lines.push_back(str_part);
        str = str.substr(str_part.length());
    }


    for (vector<string>::iterator it = lines.begin(); it != lines.end(); ++it)
    {
        print_lines.push_back(*it);
    }
}

void IRQDisplayPrint::internal_print()
{
    DrawingContext dc(Display::instance());
    //dc.clear(0xFFF);
    int cur_y = 0;

    for (vector<string>::iterator it = print_lines.begin(); it != print_lines.end(); ++it)
    {
        string str = *it;
        dc.write(Point(0, cur_y), str.c_str());
        Point up_left(dc.getFont().calculateLength(str.c_str()), cur_y);
        Point down_right(dc.getWidth() -1, cur_y + dc.getFont().getHeight());
        dc.clear(up_left, down_right, 0x0);
        cur_y += dc.getFont().getHeight();
    }
}

} //namespace miosix