Support for servos added (M340)