Add gyro & encoder