i'll push it later today.. from the top of my head it was something like this... ... #include "math.h" ... static int32_t calculatePower(int32_t thrust); ... #ifdef QUAD_FORMATION_X roll = roll >> 1; pitch = pitch >> 1; motorPowerM1 = limitThrust(calculatePower(thrust - roll + pitch + yaw)...
got to do some tests yesterday. felt a bit more stable bot not as fast. which you would expect as i didn't change the PID parameters and i scaled the power so that if the thrust was UINT16_MAX the power would be UINT16_MAX. so in all other cases(between 0 and UINT16_MAX) the power will be lower than...