Add Feedback State to Takion

This commit is contained in:
Florian Märkl 2019-06-29 16:56:49 +02:00
commit c5bb81c015
No known key found for this signature in database
GPG key ID: 125BC8A5A6A1E857
5 changed files with 139 additions and 3 deletions

View file

@ -26,7 +26,8 @@ set(HEADER_FILES
include/chiaki/congestioncontrol.h
include/chiaki/stoppipe.h
include/chiaki/reorderqueue.h
include/chiaki/discoveryservice.h)
include/chiaki/discoveryservice.h
include/chiaki/feedback.h)
set(SOURCE_FILES
src/common.c
@ -55,7 +56,8 @@ set(SOURCE_FILES
src/congestioncontrol.c
src/stoppipe.c
src/reorderqueue.c
src/discoveryservice.c)
src/discoveryservice.c
src/feedback.c)
add_subdirectory(protobuf)
include_directories("${NANOPB_SOURCE_DIR}")

View file

@ -0,0 +1,48 @@
/*
* This file is part of Chiaki.
*
* Chiaki is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* Chiaki is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with Chiaki. If not, see <https://www.gnu.org/licenses/>.
*/
#ifndef CHIAKI_FEEDBACK_H
#define CHIAKI_FEEDBACK_H
#include "common.h"
#include <stdint.h>
#ifdef __cplusplus
extern "C" {
#endif
typedef struct chiaki_feedback_state_t
{
uint16_t left_x;
uint16_t left_y;
uint16_t right_x;
uint16_t right_y;
} ChiakiFeedbackState;
#define CHIAKI_FEEDBACK_STATE_BUF_SIZE 0x19
/**
* @param buf buffer of at least CHIAKI_FEEDBACK_STATE_BUF_SIZE
*/
CHIAKI_EXPORT void chiaki_feedback_state_format(uint8_t *buf, ChiakiFeedbackState *state);
#ifdef __cplusplus
}
#endif
#endif // CHIAKI_FEEDBACK_H

View file

@ -25,6 +25,7 @@
#include "seqnum.h"
#include "stoppipe.h"
#include "reorderqueue.h"
#include "feedback.h"
#include <netinet/in.h>
#include <stdbool.h>
@ -199,6 +200,12 @@ CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_message_data(ChiakiTakion *taki
*/
CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_congestion(ChiakiTakion *takion, ChiakiTakionCongestionPacket *packet);
/**
* Thread-safe while Takion is running.
*/
CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_feedback_state(ChiakiTakion *takion, ChiakiSeqNum16 seq_num, ChiakiFeedbackState *feedback_state);
CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_av_packet_parse(ChiakiTakionAVPacket *packet, uint8_t base_type, uint8_t *buf, size_t buf_size);
#ifdef __cplusplus

45
lib/src/feedback.c Normal file
View file

@ -0,0 +1,45 @@
/*
* This file is part of Chiaki.
*
* Chiaki is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* Chiaki is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with Chiaki. If not, see <https://www.gnu.org/licenses/>.
*/
#include <chiaki/feedback.h>
#include <arpa/inet.h>
CHIAKI_EXPORT void chiaki_feedback_state_format(uint8_t *buf, ChiakiFeedbackState *state)
{
buf[0x0] = 0xa0; // TODO
buf[0x1] = 0xff; // TODO
buf[0x2] = 0x7f; // TODO
buf[0x3] = 0xff; // TODO
buf[0x4] = 0x7f; // TODO
buf[0x5] = 0xff; // TODO
buf[0x6] = 0x7f; // TODO
buf[0x7] = 0xff; // TODO
buf[0x8] = 0x7f; // TODO
buf[0x9] = 0x99; // TODO
buf[0xa] = 0x99; // TODO
buf[0xb] = 0xff; // TODO
buf[0xc] = 0x7f; // TODO
buf[0xd] = 0xfe; // TODO
buf[0xe] = 0xf7; // TODO
buf[0xf] = 0xef; // TODO
buf[0x10] = 0x1f; // TODO
*((uint16_t *)(buf + 0x11)) = htons(state->left_x);
*((uint16_t *)(buf + 0x13)) = htons(state->left_y);
*((uint16_t *)(buf + 0x15)) = htons(state->right_x);
*((uint16_t *)(buf + 0x17)) = htons(state->right_y);
}

View file

@ -396,7 +396,7 @@ CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_congestion(ChiakiTakion *takion
ChiakiErrorCode err = chiaki_mutex_lock(&takion->gkcrypt_local_mutex);
if(err != CHIAKI_ERR_SUCCESS)
return err;
*((uint32_t *)(buf + 0xb)) = htonl((uint32_t)takion->key_pos_local);
*((uint32_t *)(buf + 0xb)) = htonl((uint32_t)takion->key_pos_local); // TODO: is this correct? shouldn't key_pos be 0 for mac calculation?
err = chiaki_gkcrypt_gmac(takion->gkcrypt_local, takion->key_pos_local, buf, sizeof(buf), buf + 7);
takion->key_pos_local += sizeof(buf);
chiaki_mutex_unlock(&takion->gkcrypt_local_mutex);
@ -408,6 +408,40 @@ CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_congestion(ChiakiTakion *takion
return chiaki_takion_send_raw(takion, buf, sizeof(buf));
}
CHIAKI_EXPORT ChiakiErrorCode chiaki_takion_send_feedback_state(ChiakiTakion *takion, ChiakiSeqNum16 seq_num, ChiakiFeedbackState *feedback_state)
{
uint8_t buf[0xc + CHIAKI_FEEDBACK_STATE_BUF_SIZE];
buf[0] = TAKION_PACKET_TYPE_FEEDBACK_STATE;
*((uint16_t *)(buf + 1)) = htons(seq_num);
buf[3] = 0; // TODO
*((uint32_t *)(buf + 4)) = 0; // key pos
*((uint32_t *)(buf + 8)) = 0; // gmac
chiaki_feedback_state_format(buf + 0xc, feedback_state);
ChiakiErrorCode err = chiaki_mutex_lock(&takion->gkcrypt_local_mutex);
if(err != CHIAKI_ERR_SUCCESS)
return err;
size_t key_pos;
err = chiaki_takion_crypt_advance_key_pos(takion, CHIAKI_FEEDBACK_STATE_BUF_SIZE, &key_pos);
if(err != CHIAKI_ERR_SUCCESS)
goto beach;
err = chiaki_gkcrypt_encrypt(takion->gkcrypt_local, key_pos, buf + 0xc, CHIAKI_FEEDBACK_STATE_BUF_SIZE);
if(err != CHIAKI_ERR_SUCCESS)
goto beach;
err = chiaki_gkcrypt_gmac(takion->gkcrypt_local, key_pos, buf, sizeof(buf), buf + 4);
if(err != CHIAKI_ERR_SUCCESS)
goto beach;
*((uint32_t *)(buf + 4)) = htonl((uint32_t)key_pos);
beach:
chiaki_mutex_unlock(&takion->gkcrypt_local_mutex);
return err;
}
static ChiakiErrorCode takion_handshake(ChiakiTakion *takion)
{
ChiakiErrorCode err;