MBLoadCellData.h

Go to the documentation of this file.

/* Copyright (c) 2021 Skyward Experimental Rocketry
 * Author: Emilio Corigliano
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
 
#pragma once
 
#include <utils/Debug.h>
 
#include <cstdio>
#include <map>
 
#include "sensors/SensorData.h"
 
namespace Boardcore
{
 
enum LoadCellModes : uint8_t
{
    ASCII_MOD_TD,
    CONT_MOD_T,
    CONT_MOD_TD
};
 
enum LoadCellValuesEnum
{
    SET_SETPOINT_1,
    SET_SETPOINT_2,
    SET_SETPOINT_3,
    GET_SETPOINT_1,
    GET_SETPOINT_2,
    GET_SETPOINT_3,
    GROSS_WEIGHT,
    NET_WEIGHT,
    PEAK_WEIGHT,
    RESET_TARE,
    COMMUTE_TO_NET,
    COMMUTE_TO_GROSS
};
 
typedef std::map<const LoadCellValuesEnum, std::string> LoadCellValues;
static LoadCellValues loadCellValues = {
    {SET_SETPOINT_1, "A"},   {SET_SETPOINT_2, "B"},
    {SET_SETPOINT_3, "C"},   {GET_SETPOINT_1, "a"},
    {GET_SETPOINT_2, "b"},   {GET_SETPOINT_3, "c"},
    {GROSS_WEIGHT, "t"},     {NET_WEIGHT, "n"},
    {PEAK_WEIGHT, "p"},      {RESET_TARE, "z"},
    {COMMUTE_TO_NET, "NET"}, {COMMUTE_TO_GROSS, "GROSS"}};
 
enum ReturnsStates
{
    VALID_RETURN,
    RECEPTION_ERROR,  // contains '?'
    EXECUTION_ERROR   // contains '#'
};
 
struct MBLoadCellData : public LoadCellData
{
    bool valid = false;
 
    MBLoadCellData() : LoadCellData{0, 0.0}, valid(false) {}
 
    explicit MBLoadCellData(float data) : MBLoadCellData{0, data} {}
 
    explicit MBLoadCellData(uint64_t loadTimestamp, float data)
        : LoadCellData{loadTimestamp, data}, valid(true)
    {
    }
 
    static std::string header() { return "loadTimestamp,weight\n"; }
 
    void print(std::ostream& os) const
    {
        if (valid)
            os << loadTimestamp / 1000000.0 << "," << load << "\n";
    }
};
 
struct MBLoadCellSettings
{
    LoadCellModes mode;
    bool grossMode;
    MBLoadCellData peakWeight;
    MBLoadCellData setpoint1;
    MBLoadCellData setpoint2;
    MBLoadCellData setpoint3;
 
    void updateValue(LoadCellValuesEnum val, float data)
    {
        switch (val)
        {
            case PEAK_WEIGHT:
                peakWeight = MBLoadCellData(data);
                break;
            case GET_SETPOINT_1:
                setpoint1 = MBLoadCellData(data);
                break;
            case GET_SETPOINT_2:
                setpoint2 = MBLoadCellData(data);
                break;
            case GET_SETPOINT_3:
                setpoint3 = MBLoadCellData(data);
                break;
            default:
                break;
        }
    }
 
    void print() const
    {
        /*if (netWeight.valid)
            TRACE("Net Weight     : %f [Kg]\n", netWeight.load);
 
        if (grossWeight.valid)
            TRACE("Gross Weight   : %f [Kg]\n", grossWeight.load);
        */
        if (peakWeight.valid)
            TRACE("Peak Weight    : %f [Kg]\n", peakWeight.load);
 
        if (setpoint1.valid)
            TRACE("Setpoint 1     : %f [Kg]\n", setpoint1.load);
 
        if (setpoint2.valid)
            TRACE("Setpoint 2     : %f [Kg]\n", setpoint2.load);
 
        if (setpoint3.valid)
            TRACE("Setpoint 3     : %f [Kg]\n", setpoint3.load);
    }
};
 
struct DataModT
{
    char weight[6];
    char CRLF[2];
};
 
struct DataModTd
{
    char beginStr[1];
    char T[1];
    char weightT[6];
    char P[1];
    char weightP[6];
    char endStr[1];
    char ck[2];
    char CR[1];
};
 
struct DataAsciiRequest
{
    char beginStr[2] = "$";
    char addr[3]     = "01";
    char value[7]    = "";
    char req[6];
    char ck[3];
    char CR[2] = "\r";
 
    void setChecksum()
    {
        uint8_t checksum = 0;
        std::string str;
        str.append(addr);
        str.append(value);
        str.append(req);
 
        for (unsigned int i = 0; i < str.length(); i++)
            checksum ^= str[i];
 
        sprintf(ck, "%x", checksum);
    }
 
    std::string to_string()
    {
        std::string str;
        str.append(beginStr);
        str.append(addr);
        str.append(value);
        str.append(req);
        str.append(ck);
        str.append(CR);
        return str;
    }
};
 
}  // namespace Boardcore