Updates to Quadcopter2