Added encoders, gyro and init codes.