Geyser/connector/src/main/java/org/geysermc/connector/network/QueryPacketHandler.java

/*
 * Copyright (c) 2019-2020 GeyserMC. http://geysermc.org
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 *
 * @author GeyserMC
 * @link https://github.com/GeyserMC/Geyser
 */

package org.geysermc.connector.network;

import com.github.steveice10.mc.protocol.data.message.MessageSerializer;
import io.netty.buffer.ByteBuf;
import io.netty.buffer.ByteBufAllocator;
import org.geysermc.connector.common.ping.GeyserPingInfo;
import org.geysermc.connector.GeyserConnector;
import org.geysermc.connector.utils.MessageUtils;

import java.io.ByteArrayOutputStream;
import java.io.IOException;
import java.net.InetAddress;
import java.net.InetSocketAddress;
import java.nio.ByteBuffer;
import java.nio.charset.StandardCharsets;
import java.security.MessageDigest;
import java.security.NoSuchAlgorithmException;
import java.util.Arrays;
import java.util.HashMap;
import java.util.Map;
import java.util.Random;
import java.util.concurrent.ThreadLocalRandom;

public class QueryPacketHandler {

    public static final byte HANDSHAKE = 0x09;
    public static final byte STATISTICS = 0x00;

    private GeyserConnector connector;
    private InetSocketAddress sender;
    private byte type;
    private int sessionId;
    private byte[] token;

    /**
     * The Query packet handler instance
     *
     * @param connector Geyser Connector
     * @param sender The Sender IP/Port for the Query
     * @param buffer The Query data
     */
    public QueryPacketHandler(GeyserConnector connector, InetSocketAddress sender, ByteBuf buffer) {
        if(!isQueryPacket(buffer))
            return;

        this.connector = connector;
        this.sender = sender;
        this.type = buffer.readByte();
        this.sessionId = buffer.readInt();

        regenerateToken();
        handle();
    }

    /**
     * Checks the packet is in fact a query packet
     *
     * @param buffer Query data
     * @return if the packet is a query packet
     */
    private boolean isQueryPacket(ByteBuf buffer) {
        return (buffer.readableBytes() >= 2) ? buffer.readUnsignedShort() == 0xFEFD : false;
    }

    /**
     * Handles the query
     */
    private void handle() {
        switch (type) {
            case HANDSHAKE:
                sendToken();
            case STATISTICS:
                sendQueryData();
        }
    }

    /**
     * Sends the token to the sender
     */
    private void sendToken() {
        ByteBuf reply = ByteBufAllocator.DEFAULT.ioBuffer(10);
        reply.writeByte(HANDSHAKE);
        reply.writeInt(sessionId);
        reply.writeBytes(getTokenString(this.token, this.sender.getAddress()));
        reply.writeByte(0);

        sendPacket(reply);
    }

    /**
     * Sends the query data to the sender
     */
    private void sendQueryData() {
        ByteBuf reply = ByteBufAllocator.DEFAULT.ioBuffer(64);
        reply.writeByte(STATISTICS);
        reply.writeInt(sessionId);

        // Game Info
        reply.writeBytes(getGameData());

        // Players
        reply.writeBytes(getPlayers());

        sendPacket(reply);
    }

    /**
     * Gets the game data for the query
     *
     * @return the game data for the query
     */
    private byte[] getGameData() {
        ByteArrayOutputStream query = new ByteArrayOutputStream();

        GeyserPingInfo pingInfo = null;
        String motd;
        String currentPlayerCount;
        String maxPlayerCount;

        if (connector.getConfig().isPassthroughMotd() || connector.getConfig().isPassthroughPlayerCounts()) {
            pingInfo = connector.getBootstrap().getGeyserPingPassthrough().getPingInformation();
        }

        if (connector.getConfig().isPassthroughMotd() && pingInfo != null) {
            String[] javaMotd = MessageUtils.getBedrockMessage(MessageSerializer.fromString(pingInfo.getDescription())).split("\n");
            motd = javaMotd[0].trim(); // First line of the motd.
        } else {
            motd = connector.getConfig().getBedrock().getMotd1();
        }

        // If passthrough player counts is enabled lets get players from the server
        if (connector.getConfig().isPassthroughPlayerCounts() && pingInfo != null) {
            currentPlayerCount = String.valueOf(pingInfo.getPlayers().getOnline());
            maxPlayerCount = String.valueOf(pingInfo.getPlayers().getMax());
        } else {
            currentPlayerCount = String.valueOf(connector.getPlayers().size());
            maxPlayerCount = String.valueOf(connector.getConfig().getMaxPlayers());
        }

        // Create a hashmap of all game data needed in the query
        Map<String, String> gameData = new HashMap<String, String>();
        gameData.put("hostname", motd);
        gameData.put("gametype", "SMP");
        gameData.put("game_id", "MINECRAFT");
        gameData.put("version", GeyserConnector.BEDROCK_PACKET_CODEC.getMinecraftVersion());
        gameData.put("plugins", "");
        gameData.put("map", GeyserConnector.NAME);
        gameData.put("numplayers", currentPlayerCount);
        gameData.put("maxplayers", maxPlayerCount);
        gameData.put("hostport", String.valueOf(connector.getConfig().getBedrock().getPort()));
        gameData.put("hostip", connector.getConfig().getBedrock().getAddress());

        try {
            // Blank Buffer Bytes
            query.write("GeyserMC".getBytes());
            query.write((byte) 0x00);
            query.write((byte) 0x80);
            query.write((byte) 0x00);

            // Fills the game data
            for(Map.Entry<String, String> entry : gameData.entrySet()) {
                query.write(entry.getKey().getBytes());
                query.write((byte) 0x00);
                query.write(entry.getValue().getBytes());
                query.write((byte) 0x00);
            }

            // Final byte to show the end of the game data
            query.write(new byte[] { 0x00, 0x01 });
            return query.toByteArray();
        } catch (IOException e) {
            e.printStackTrace();
            return new byte[0];
        }
    }

    /**
     * Generate a byte[] storing the player names
     *
     * @return The byte[] representation of players
     */
    private byte[] getPlayers() {
        ByteArrayOutputStream query = new ByteArrayOutputStream();

        GeyserPingInfo pingInfo = null;
        if (connector.getConfig().isPassthroughMotd() || connector.getConfig().isPassthroughPlayerCounts()) {
            pingInfo = connector.getBootstrap().getGeyserPingPassthrough().getPingInformation();
        }

        try {
            // Start the player section
            query.write("player_".getBytes());
            query.write(new byte[] { 0x00, 0x00 });

            // Fill player names
            if(pingInfo != null) {
                for (String username : pingInfo.getPlayerList()) {
                    query.write(username.getBytes());
                    query.write((byte) 0x00);
                }
            }

            // Final byte to show the end of the player data
            query.write((byte) 0x00);
            return query.toByteArray();
        } catch (IOException e) {
            e.printStackTrace();
            return new byte[0];
        }
    }

    /**
     * Sends a packet to the sender
     *
     * @param data packet data
     */
    private void sendPacket(ByteBuf data) {
        connector.getBedrockServer().getRakNet().send(sender, data);
    }

    /**
     * Regenerates a token
     */
    public void regenerateToken() {
        byte[] token = new byte[16];
        for (int i = 0; i < 16; i++) {
            token[i] = (byte) new Random().nextInt(255);
        }

        this.token = token;
    }

    /**
     * Gets an MD5 token for the current IP/Port.
     * This should reset every 30 seconds but a new one is generated per instance
     * Seems wasteful to code something in to clear it when it has no use.
     *
     * @param token the token
     * @param address the address
     * @return an MD5 token for the current IP/Port
     */
    public static byte[] getTokenString(byte[] token, InetAddress address) {
        try {
            // Generate an MD5 hash from the address
            MessageDigest digest = MessageDigest.getInstance("MD5");
            digest.update(address.toString().getBytes(StandardCharsets.UTF_8));
            digest.update(token);

            // Get the first 4 bytes of the digest
            byte[] digestBytes = Arrays.copyOf(digest.digest(), 4);

            // Convert the bytes to a buffer
            ByteBuffer byteBuffer = ByteBuffer.wrap(digestBytes);

            // Turn the number into a null terminated string
            return (byteBuffer.getInt() + "\0").getBytes();
        } catch (NoSuchAlgorithmException e) {
            return (ByteBuffer.allocate(4).putInt(ThreadLocalRandom.current().nextInt()).getInt() + "\0").getBytes();
        }
    }
}