- if(write(device_fd, packet->data + 14, packet->len - 14) < 0) {
- logger(LOG_ERR, _("Can't write to %s %s: %s"), device_info,
- device, strerror(errno));
- return false;
+ free(device); device = NULL;
+ free(iface); iface = NULL;
+}
+
+static bool read_packet(vpn_packet_t *packet) {
+ int inlen;
+
+ switch(device_type) {
+ case DEVICE_TYPE_TUN:
+ if((inlen = read(device_fd, packet->data + 14, MTU - 14)) <= 0) {
+ logger(DEBUG_ALWAYS, LOG_ERR, "Error while reading from %s %s: %s", device_info, device, strerror(errno));
+ return false;
+ }
+
+ switch(packet->data[14] >> 4) {
+ case 4:
+ packet->data[12] = 0x08;
+ packet->data[13] = 0x00;
+ break;
+ case 6:
+ packet->data[12] = 0x86;
+ packet->data[13] = 0xDD;
+ break;
+ default:
+ logger(DEBUG_TRAFFIC, LOG_ERR, "Unknown IP version %d while reading packet from %s %s", packet->data[14] >> 4, device_info, device);
+ return false;
+ }
+
+ memset(packet->data, 0, 12);
+ packet->len = inlen + 14;
+ break;
+
+ case DEVICE_TYPE_TAP:
+ if((inlen = read(device_fd, packet->data, MTU)) <= 0) {
+ logger(DEBUG_ALWAYS, LOG_ERR, "Error while reading from %s %s: %s", device_info, device, strerror(errno));
+ return false;
+ }
+
+ packet->len = inlen + 14;
+ break;
+
+ default:
+ abort();