/* Chrysalide - Outil d'analyse de fichiers binaires
* vmpa.c - adressages virtuels ou physiques
*
* Copyright (C) 2014 Cyrille Bagard
*
* This file is part of Chrysalide.
*
* OpenIDA 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.
*
* OpenIDA 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 Foobar. If not, see .
*/
#include "vmpa.h"
#include
#include
#include
#include
#include "../common/io.h"
/******************************************************************************
* *
* Paramètres : addr = élément à initialiser. *
* phy = position dans la mémoire physique. *
* virt = adresse dans la mémoire virtuelle. *
* *
* Description : Initialise une localisation dans l'espace mémoire/physique. *
* *
* Retour : Adressage alloué en mémoire. *
* *
* Remarques : - *
* *
******************************************************************************/
void init_vmpa(vmpa2t *addr, off_t phy, uint64_t virt)
{
addr->physical = phy;
addr->virtual = virt;
}
/******************************************************************************
* *
* Paramètres : phy = position dans la mémoire physique. *
* virt = adresse dans la mémoire virtuelle. *
* *
* Description : Crée une localisation dans l'adressage mémoire. *
* *
* Retour : Adressage alloué en mémoire. *
* *
* Remarques : - *
* *
******************************************************************************/
vmpa2t *make_vmpa(off_t phy, uint64_t virt)
{
vmpa2t *result; /* Structure à retourner */
result = (vmpa2t *)calloc(1, sizeof(vmpa2t));
init_vmpa(result, phy, virt);
return result;
}
/******************************************************************************
* *
* Paramètres : dest = structure de destination pour la copie. *
* src = structure de source pour la copie. *
* *
* Description : Copie la définition d'un adressage dans un autre. *
* *
* Retour : - *
* *
* Remarques : - *
* *
******************************************************************************/
void copy_vmpa(vmpa2t *dest, const vmpa2t *src)
{
dest->physical = src->physical;
dest->virtual = src->virtual;
}
/******************************************************************************
* *
* Paramètres : a = première définition à analyser. *
* b = seconde définition à analyser. *
* *
* Description : Compare entre elles deux adresses physiques. *
* *
* Retour : Bilan de la comparaison : -1, 0 ou 1. *
* *
* Remarques : - *
* *
******************************************************************************/
int cmp_vmpa_by_phy(const vmpa2t *a, const vmpa2t *b)
{
int result; /* Bilan à retourner */
if (a->physical != VMPA_NO_PHYSICAL && b->physical != VMPA_NO_PHYSICAL)
{
if (a->physical < b->physical) result = -1;
else if (a->physical > b->physical) result = 1;
else result = 0;
}
else
{
if (a->physical == VMPA_NO_PHYSICAL && b->physical == VMPA_NO_PHYSICAL) result = 0;
else if (a->physical == VMPA_NO_PHYSICAL) result = -1;
else result = 1;
}
return result;
}
/******************************************************************************
* *
* Paramètres : a = première définition à analyser. *
* b = seconde définition à analyser. *
* *
* Description : Compare entre elles deux adresses virtuelles. *
* *
* Retour : Bilan de la comparaison : -1, 0 ou 1. *
* *
* Remarques : - *
* *
******************************************************************************/
int cmp_vmpa_by_virt(const vmpa2t *a, const vmpa2t *b)
{
int result; /* Bilan à retourner */
if (a->virtual != VMPA_NO_VIRTUAL && b->virtual != VMPA_NO_VIRTUAL)
{
if (a->virtual < b->virtual) result = -1;
else if (a->virtual > b->virtual) result = 1;
else result = 0;
}
else
{
if (a->virtual == VMPA_NO_VIRTUAL && b->virtual == VMPA_NO_VIRTUAL) result = 0;
else if (a->virtual == VMPA_NO_VIRTUAL) result = -1;
else result = 1;
}
return result;
}
/******************************************************************************
* *
* Paramètres : a = première définition à analyser. *
* b = seconde définition à analyser. *
* *
* Description : Compare deux localisations selon leurs parties définies. *
* *
* Retour : Bilan de la comparaison : -1, 0 ou 1 (-1 par défaut). *
* *
* Remarques : - *
* *
******************************************************************************/
int cmp_vmpa(const vmpa2t *a, const vmpa2t *b)
{
int result; /* Bilan à retourner */
bool half; /* Comparaison débutée */
result = -1;
half = false;
if (a->physical != VMPA_NO_PHYSICAL && b->physical != VMPA_NO_PHYSICAL)
{
result = cmp_vmpa_by_phy(a, b);
half = true;
}
if (a->virtual != VMPA_NO_VIRTUAL && b->virtual != VMPA_NO_VIRTUAL
&& (!half || (half && result == 0)))
{
result = cmp_vmpa_by_virt(a, b);
}
return result;
}
/******************************************************************************
* *
* Paramètres : addr = élément à modifier. *
* qty = quantité d'unités de décallage. *
* *
* Description : Décalle une position d'une certaine quantité. *
* *
* Retour : - *
* *
* Remarques : - *
* *
******************************************************************************/
void advance_vmpa(vmpa2t *addr, off_t qty)
{
if (addr->physical != VMPA_NO_PHYSICAL)
addr->physical += qty;
if (addr->virtual != VMPA_NO_VIRTUAL)
addr->virtual += qty;
}
/******************************************************************************
* *
* Paramètres : a = première élément à venir consulter. *
* b = second élément à traiter en parallèle. *
* *
* Description : Calcule au mieux la distance entre deux coordonnées. *
* *
* Retour : Distance absolue entre deux localisations. *
* *
* Remarques : - *
* *
******************************************************************************/
off_t compute_vmpa_diff(const vmpa2t *a, const vmpa2t *b)
{
off_t result; /* Valeur à retourner */
result = VMPA_NO_PHYSICAL;
if (a->physical != VMPA_NO_PHYSICAL && b->physical != VMPA_NO_PHYSICAL)
result = (b->physical > a->physical ? b->physical - a->physical : a->physical- b->physical);
else if (a->virtual != VMPA_NO_VIRTUAL && b->virtual != VMPA_NO_VIRTUAL)
result = (off_t)(b->virtual > a->virtual ? b->virtual - a->virtual : a->virtual- b->virtual);
return result;
}
/******************************************************************************
* *
* Paramètres : addr = élément à venir lire. [OUT] *
* fd = flux ouvert en lecture pour l'importation. *
* flags = éventuelles options d'envoi supplémentaires. *
* *
* Description : Lit la définition d'une adresse depuis un flux réseau. *
* *
* Retour : Bilan de l'opération. *
* *
* Remarques : - *
* *
******************************************************************************/
bool recv_vmpa(vmpa2t *addr, int fd, int flags)
{
uint64_t val64; /* Valeur sur 64 bits */
bool status; /* Bilan d'une réception */
status = safe_recv(fd, &val64, sizeof(uint64_t), flags);
if (!status) return false;
addr->physical = be64toh(val64);
status = safe_recv(fd, &val64, sizeof(uint64_t), flags);
if (!status) return false;
addr->virtual = be64toh(val64);
return true;
}
/******************************************************************************
* *
* Paramètres : addr = élément à venir écrire. *
* fd = flux ouvert en écriture pour l'exportation. *
* flags = éventuelles options d'envoi supplémentaires. *
* *
* Description : Ecrit la définition d'une adresse dans un flux réseau. *
* *
* Retour : Bilan de l'opération. *
* *
* Remarques : - *
* *
******************************************************************************/
bool send_vmpa(const vmpa2t *addr, int fd, int flags)
{
bool status; /* Bilan d'une émission */
status = safe_send(fd, (uint64_t []) { htobe64(addr->physical) }, sizeof(uint64_t), flags);
if (!status) return false;
status = safe_send(fd, (uint64_t []) { htobe64(addr->virtual) }, sizeof(uint64_t), flags);
if (!status) return false;
return true;
}
/******************************************************************************
* *
* Paramètres : addr = adresse virtuelle ou physique à traiter. *
* msize = taille de cette adresse, réelle ou désirée. *
* buffer = tampon de sortie utilisé à constituer. [OUT] *
* length = transmission de la taille du résultat ou NULL. [OUT]*
* *
* Description : Transforme une adresse physique en chaîne de caractères. *
* *
* Retour : Chaîne de caractères constituée. *
* *
* Remarques : - *
* *
******************************************************************************/
char *vmpa2_phys_to_string(const vmpa2t *addr, MemoryDataSize msize, char buffer[VMPA_MAX_LEN], size_t *length)
{
size_t ret; /* Retour de l'impression */
switch (msize)
{
case MDS_8_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE,"0x%02" PRIx64, addr->physical);
break;
case MDS_16_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%04" PRIx64, addr->physical);
break;
case MDS_32_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%08" PRIx64, addr->physical);
break;
case MDS_64_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%016" PRIx64, addr->physical);
break;
default:
ret = snprintf(buffer, VMPA_MAX_SIZE, "???");
break;
}
if (length != NULL)
*length = ret;
return buffer;
}
/******************************************************************************
* *
* Paramètres : addr = adresse virtuelle ou physique à traiter. *
* msize = taille de cette adresse, réelle ou désirée. *
* buffer = tampon de sortie utilisé à constituer. [OUT] *
* length = transmission de la taille du résultat ou NULL. [OUT]*
* *
* Description : Transforme une adresse virtuelle en chaîne de caractères. *
* *
* Retour : Chaîne de caractères constituée. *
* *
* Remarques : - *
* *
******************************************************************************/
char *vmpa2_virt_to_string(const vmpa2t *addr, MemoryDataSize msize, char buffer[VMPA_MAX_LEN], size_t *length)
{
size_t ret; /* Retour de l'impression */
switch (msize)
{
case MDS_8_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE,"0x%02" PRIx64, addr->virtual);
break;
case MDS_16_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%04" PRIx64, addr->virtual);
break;
case MDS_32_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%08" PRIx64, addr->virtual);
break;
case MDS_64_BITS:
ret = snprintf(buffer, VMPA_MAX_SIZE, "0x%016" PRIx64, addr->virtual);
break;
default:
ret = snprintf(buffer, VMPA_MAX_SIZE, "???");
break;
}
if (length != NULL)
*length = ret;
return buffer;
}
/******************************************************************************
* *
* Paramètres : buffer = chaîne de caractères à consulter. *
* *
* Description : Transforme une chaîne de caractères en position physique. *
* *
* Retour : Adresse obtenue. *
* *
* Remarques : - *
* *
******************************************************************************/
vmpa2t *string_to_vmpa_phy(const char *buffer)
{
off_t physical; /* Position à retrouver */
physical = strtoull(buffer, NULL, 16);
return make_vmpa(physical, VMPA_NO_VIRTUAL);
}
/******************************************************************************
* *
* Paramètres : buffer = chaîne de caractères à consulter. *
* *
* Description : Transforme une chaîne de caractères en adresse virtuelle. *
* *
* Retour : Adresse obtenue. *
* *
* Remarques : - *
* *
******************************************************************************/
vmpa2t *string_to_vmpa_virt(const char *buffer)
{
uint64_t virtual; /* Adresse à retrouver */
virtual = strtoull(buffer, NULL, 16);
return make_vmpa(VMPA_NO_PHYSICAL, virtual);
}