Revert "Remove MT_ENABLED param and handles"

This reverts commit 90a5ae1afd.

src/modules/fw_pos_control_l1/mtecs/mTecs.cpp

@@ -49,6 +49,7 @@ namespace fwPosctrl {
 mTecs::mTecs() :
 	SuperBlock(NULL, "MT"),
 	/* Parameters */
+	_mTecsEnabled(this, "ENABLED"),
 	_airspeedMin(this, "FW_AIRSPD_MIN", false),
 	/* Publications */
 	_status(&getPublications(), ORB_ID(tecs_status)),

src/modules/fw_pos_control_l1/mtecs/mTecs.h

@@ -90,12 +90,14 @@ public:
 	void resetDerivatives(float airspeed);
 
 	/* Accessors */
+	bool getEnabled() { return _mTecsEnabled.get() > 0; }
 	float getThrottleSetpoint() { return _throttleSp; }
 	float getPitchSetpoint() { return _pitchSp; }
 	float airspeedLowpassUpdate(float input) { return _airspeedLowpass.update(input); }
 
 protected:
 	/* parameters */
+	control::BlockParamInt _mTecsEnabled;		/**< 1 if mTecs is enabled */
 	control::BlockParamFloat _airspeedMin;		/**< minimal airspeed */
 
 	/* Publications */

src/modules/fw_pos_control_l1/mtecs/mTecs_params.c

@@ -46,6 +46,17 @@
  * Controller parameters, accessible via MAVLink
  */
 
+/**
+ * mTECS enabled
+ *
+ * Set to 1 to enable mTECS
+ *
+ * @min 0
+ * @max 1
+ * @group mTECS
+ */
+PARAM_DEFINE_INT32(MT_ENABLED, 1);
+
 /**
  * Total Energy Rate Control Feedforward
  * Maps the total energy rate setpoint to the throttle setpoint