Subversion Repositories Projects

Rev

Rev 2000 | Rev 2043 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | RSS feed

/****************************************************************************
 *   Copyright (C) 2009-2014 by Claas Anders "CaScAdE" Rathje               *
 *   admiralcascade@gmail.com                                               *
 *   Project-URL: http://www.mylifesucks.de/oss/c-osd/                      *
 *                                                                          *
 *   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.         *
 *                                                                          *
 *   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.              *
 ****************************************************************************/


#ifndef _MK_DATA_STRUCTS_H
#define _MK_DATA_STRUCTS_H

/* ##########################################################################
 * gain some fake arm compat :)
 * ##########################################################################*/

#define u8 uint8_t
#define s8 int8_t
#define u16 uint16_t
#define s16 int16_t
#define u32 uint32_t
#define s32 int32_t

/**
 * MikroKopter Slave-Addresses
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=NaviCtrl&path=/tags/V0.22a/mkprotocol.h
 */

#define ANY_ADDRESS 0
#define FC_ADDRESS 1
#define NC_ADDRESS 2
#define MK3MAG_ADDRESS 3
#define MKOSD_ADDRESS 4
#define BL_ADDRESS 5

/*
 * FC Debug Struct
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=FlightCtrl&path=/tags/V0.88e/uart.h
 */

typedef struct {
    unsigned char Status[2];
    signed int Analog[32]; // Debugwerte
} __attribute__((packed)) str_DebugOut;

typedef struct {
    unsigned char SWMajor;
    unsigned char SWMinor;
    unsigned char ProtoMajor;
    unsigned char ProtoMinor;
    unsigned char SWPatch;
    unsigned char HardwareError[5];
} __attribute__((packed)) str_VersionInfo;

/*
 * NaviCtrl GPS Structs
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=NaviCtrl&path=/tags/V0.20c/ubx.h
 */

typedef struct {
    s32 Longitude; // in 1E-7 deg
    s32 Latitude; // in 1E-7 deg
    s32 Altitude; // in mm
    u8 Status; // validity of data
} __attribute__((packed)) GPS_Pos_t;

#define INVALID         0x00
#define NEWDATA         0x01
#define PROCESSED       0x02

/*
 * NaviCtrl OSD Structs
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=NaviCtrl&path=/tags/V2.04a/uart1.h
 */

typedef struct {
    u16 Distance; // distance to target in dm
    s16 Bearing; // course to target in deg
} __attribute__((packed)) GPS_PosDev_t;
#define NAVIDATA_VERSION 5

typedef struct {
    u8 Version; // version of the data structure
    GPS_Pos_t CurrentPosition; // see gpspos.h for details
    GPS_Pos_t TargetPosition;
    GPS_PosDev_t TargetPositionDeviation;
    GPS_Pos_t HomePosition;
    GPS_PosDev_t HomePositionDeviation;
    u8 WaypointIndex; // index of current waypoints running from 0 to WaypointNumber-1
    u8 WaypointNumber; // number of stored waypoints
    u8 SatsInUse; // number of satellites used for position solution
    s16 Altimeter; // hight according to air pressure
    s16 Variometer; // climb(+) and sink(-) rate
    u16 FlyingTime; // in seconds
    u8 UBat; // Battery Voltage in 0.1 Volts
    u16 GroundSpeed; // speed over ground in cm/s (2D)
    s16 Heading; // current flight direction in ° as angle to north
    s16 CompassHeading; // current compass value in °
    s8 AngleNick; // current Nick angle in 1°
    s8 AngleRoll; // current Rick angle in 1°
    u8 RC_Quality; // RC_Quality
    u8 FCStatusFlags; // Flags from FC
    u8 NCFlags; // Flags from NC
    u8 Errorcode; // 0 --> okay
    u8 OperatingRadius; // current operation radius around the Home Position in m
    s16 TopSpeed; // velocity in vertical direction in cm/s
    u8 TargetHoldTime; // time in s to stay at the given target, counts down to 0 if target has been reached
    u8 FCStatusFlags2; // StatusFlags2 (since version 5 added)
    s16 SetpointAltitude; // setpoint for altitude
    u8 Gas; // for future use
    u16 Current; // actual current in 0.1A steps
    u16 UsedCapacity; // used capacity in mAh
} __attribute__((packed)) NaviData_t;

#define NC_FLAG_FREE                    0x01
#define NC_FLAG_PH                              0x02
#define NC_FLAG_CH                              0x04
#define NC_FLAG_RANGE_LIMIT             0x08
#define NC_FLAG_NOSERIALLINK    0x10
#define NC_FLAG_TARGET_REACHED  0x20
#define NC_FLAG_MANUAL_CONTROL  0x40
#define NC_FLAG_GPS_OK                  0x80

/*
 * MikroKopter Flags
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=FlightCtrl&path=/tags/V0.80d/fc.h
 */

#define FCFLAG_MOTOR_RUN        0x01
#define FCFLAG_FLY              0x02
#define FCFLAG_CALIBRATE        0x04
#define FCFLAG_START            0x08
#define FCFLAG_NOTLANDUNG       0x10
#define FCFLAG_LOWBAT           0x20
#define FCFLAG_VARIO_TRIM_UP    0x40
#define FCFLAG_VARIO_TRIM_DOWN  0x80

// FC STATUS FLAGS2
#define FC_STATUS2_CAREFREE                 0x01
#define FC_STATUS2_ALTITUDE_CONTROL         0x02

#define DEFEKT_G_NICK           0x01
#define DEFEKT_G_ROLL           0x02
#define DEFEKT_G_GIER           0x04
#define DEFEKT_A_NICK           0x08
#define DEFEKT_A_ROLL           0x10
#define DEFEKT_A_Z              0x20
#define DEFEKT_PRESSURE         0x40
#define DEFEKT_CAREFREE_ERR 0x80

#define DEFEKT_I2C              0x01
#define DEFEKT_BL_MISSING       0x02
#define DEFEKT_SPI_RX_ERR       0x04
#define DEFEKT_PPM_ERR          0x08
#define DEFEKT_MIXER_ERR    0x10

/*
 * MikroKopter config struct
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=FlightCtrl&path=/tags/V2.04a/eeprom.h
 */


#define EEPARAM_REVISION         98 // is count up, if paramater stucture has changed (compatibility)

typedef struct {
    unsigned char Revision;
    unsigned char Kanalbelegung[12]; // GAS[0], GIER[1],NICK[2], ROLL[3], POTI1, POTI2, POTI3
    unsigned char GlobalConfig; // 0x01=Höhenregler aktiv,0x02=Kompass aktiv, 0x04=GPS aktiv, 0x08=Heading Hold aktiv
    unsigned char Hoehe_MinGas; // Wert : 0-100
    unsigned char Luftdruck_D; // Wert : 0-250
    unsigned char HoeheChannel; // Wert : 0-32
    unsigned char Hoehe_P; // Wert : 0-32
    unsigned char Hoehe_Verstaerkung; // Wert : 0-50
    unsigned char Hoehe_ACC_Wirkung; // Wert : 0-250
    unsigned char Hoehe_HoverBand; // Wert : 0-250
    unsigned char Hoehe_GPS_Z; // Wert : 0-250
    unsigned char Hoehe_StickNeutralPoint; // Wert : 0-250
    unsigned char Stick_P; // Wert : 1-6
    unsigned char Stick_D; // Wert : 0-64
    unsigned char StickGier_P; // Wert : 1-20
    unsigned char Gas_Min; // Wert : 0-32
    unsigned char Gas_Max; // Wert : 33-250
    unsigned char GyroAccFaktor; // Wert : 1-64
    unsigned char KompassWirkung; // Wert : 0-32
    unsigned char Gyro_P; // Wert : 10-250
    unsigned char Gyro_I; // Wert : 0-250
    unsigned char Gyro_D; // Wert : 0-250
    unsigned char Gyro_Gier_P; // Wert : 10-250
    unsigned char Gyro_Gier_I; // Wert : 0-250
    unsigned char Gyro_Stability; // Wert : 0-16
    unsigned char UnterspannungsWarnung; // Wert : 0-250
    unsigned char NotGas; // Wert : 0-250     //Gaswert bei Empängsverlust
    unsigned char NotGasZeit; // Wert : 0-250     // Zeitbis auf NotGas geschaltet wird, wg. Rx-Problemen
    unsigned char Receiver; // 0= Summensignal, 1= Spektrum, 2 =Jeti, 3=ACT DSL, 4=ACT S3D
    unsigned char I_Faktor; // Wert : 0-250
    unsigned char UserParam1; // Wert : 0-250
    unsigned char UserParam2; // Wert : 0-250
    unsigned char UserParam3; // Wert : 0-250
    unsigned char UserParam4; // Wert : 0-250
    unsigned char ServoNickControl; // Wert : 0-250     // Stellung des Servos
    unsigned char ServoNickComp; // Wert : 0-250     // Einfluss Gyro/Servo
    unsigned char ServoNickMin; // Wert : 0-250     // Anschlag
    unsigned char ServoNickMax; // Wert : 0-250     // Anschlag
    //--- Seit V0.75
    unsigned char ServoRollControl; // Wert : 0-250     // Stellung des Servos
    unsigned char ServoRollComp; // Wert : 0-250
    unsigned char ServoRollMin; // Wert : 0-250
    unsigned char ServoRollMax; // Wert : 0-250
    //---
    unsigned char ServoNickRefresh; // Speed of the Servo
    unsigned char ServoManualControlSpeed; //
    unsigned char CamOrientation; //
    unsigned char Servo3; // Value or mapping of the Servo Output
    unsigned char Servo4; // Value or mapping of the Servo Output
    unsigned char Servo5; // Value or mapping of the Servo Output
    unsigned char LoopGasLimit; // Wert: 0-250  max. Gas während Looping
    unsigned char LoopThreshold; // Wert: 0-250  Schwelle für Stickausschlag
    unsigned char LoopHysterese; // Wert: 0-250  Hysterese für Stickausschlag
    unsigned char AchsKopplung1; // Wert: 0-250  Faktor, mit dem Gier die Achsen Roll und Nick koppelt (NickRollMitkopplung)
    unsigned char AchsKopplung2; // Wert: 0-250  Faktor, mit dem Nick und Roll verkoppelt werden
    unsigned char CouplingYawCorrection; // Wert: 0-250  Faktor, mit dem Nick und Roll verkoppelt werden
    unsigned char WinkelUmschlagNick; // Wert: 0-250  180°-Punkt
    unsigned char WinkelUmschlagRoll; // Wert: 0-250  180°-Punkt
    unsigned char GyroAccAbgleich; // 1/k  (Koppel_ACC_Wirkung)
    unsigned char Driftkomp;
    unsigned char DynamicStability;
    unsigned char UserParam5; // Wert : 0-250
    unsigned char UserParam6; // Wert : 0-250
    unsigned char UserParam7; // Wert : 0-250
    unsigned char UserParam8; // Wert : 0-250
    //---Output ---------------------------------------------
    unsigned char J16Bitmask; // for the J16 Output
    unsigned char J16Timing; // for the J16 Output
    unsigned char J17Bitmask; // for the J17 Output
    unsigned char J17Timing; // for the J17 Output
    // seit version V0.75c
    unsigned char WARN_J16_Bitmask; // for the J16 Output
    unsigned char WARN_J17_Bitmask; // for the J17 Output
    //---NaviCtrl---------------------------------------------
    unsigned char NaviOut1Parameter; // for the J16 Output
    unsigned char NaviGpsModeChannel; // Parameters for the Naviboard
    unsigned char NaviGpsGain;
    unsigned char NaviGpsP;
    unsigned char NaviGpsI;
    unsigned char NaviGpsD;
    unsigned char NaviGpsPLimit;
    unsigned char NaviGpsILimit;
    unsigned char NaviGpsDLimit;
    unsigned char NaviGpsA;
    unsigned char NaviGpsMinSat;
    unsigned char NaviStickThreshold;
    unsigned char NaviWindCorrection;
    unsigned char NaviAccCompensation; // New since 0.86 -> was: SpeedCompensation
    unsigned char NaviOperatingRadius;
    unsigned char NaviAngleLimitation;
    unsigned char NaviPH_LoginTime;
    //---Ext.Ctrl---------------------------------------------
    unsigned char ExternalControl; // for serial Control
    //---CareFree---------------------------------------------
    unsigned char OrientationAngle; // Where is the front-direction?
    unsigned char CareFreeChannel; // switch for CareFree
    unsigned char MotorSafetySwitch;
    unsigned char MotorSmooth;
    unsigned char ComingHomeAltitude;
    unsigned char FailSafeTime;
    unsigned char MaxAltitude;
    unsigned char FailsafeChannel; // if the value of this channel is > 100, the MK reports "RC-Lost"
    unsigned char ServoFilterNick;
    unsigned char ServoFilterRoll;
    unsigned char StartLandChannel;
    unsigned char LandingSpeed;
    unsigned char CompassOffset;
    unsigned char AutoLandingVoltage; // in 0,1V  0 -> disabled
    unsigned char ComingHomeVoltage; // in 0,1V  0 -> disabled
    //------------------------------------------------
    unsigned char BitConfig; // (war Loop-Cfg) Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts / wird getrennt behandelt
    unsigned char ServoCompInvert; // //  0x01 = Nick, 0x02 = Roll, 0x04 = relative moving // WICHTIG!!! am Ende lassen
    unsigned char ExtraConfig; // bitcodiert
    unsigned char GlobalConfig3; // bitcodiert
    char Name[12];
    unsigned char crc; // must be the last byte!
} paramset_t; // 127 bytes

typedef struct {
    u8 SettingsIndex;
    paramset_t param;
} __attribute__((packed)) paramset_serial;

/*
 * MikroKopter 3D-Data struct
 * portions taken and adapted from
 * http://svn.mikrokopter.de/filedetails.php?repname=NaviCtrl&path=%2Ftags%2FV0.28o%2Fuart1.h
 */

typedef struct {
    s16 AngleNick; // in 0.1 deg
    s16 AngleRoll; // in 0.1 deg
    s16 Heading; // in 0.1 deg
    u8 StickNick;
    u8 StickRoll;
    u8 StickYaw;
    u8 StickGas;
    u8 reserve[4];
} __attribute__((packed)) Data3D_t;

extern Data3D_t Data3D;

#endif