00001 /* 00002 * Copyright Droids Corporation, Microb Technology, Eirbot (2005) 00003 * 00004 * This program is free software; you can redistribute it and/or modify 00005 * it under the terms of the GNU General Public License as published by 00006 * the Free Software Foundation; either version 2 of the License, or 00007 * (at your option) any later version. 00008 * 00009 * This program is distributed in the hope that it will be useful, 00010 * but WITHOUT ANY WARRANTY; without even the implied warranty of 00011 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00012 * GNU General Public License for more details. 00013 * 00014 * You should have received a copy of the GNU General Public License 00015 * along with this program; if not, write to the Free Software 00016 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 00017 * 00018 * Revision : $Id: f32_double.c,v 1.6 2008-05-14 13:27:12 zer0 Exp $ 00019 * 00020 */ 00021 00022 #include <stdio.h> 00023 #include <f32.h> 00024 00025 /* value of 2^^16 in float */ 00026 #define POW2_16F (65536.0) 00027 00028 00029 /**************** double <-> f32 */ 00030 00031 f32 f32_from_double(double d) 00032 { 00033 f32 f; 00034 f.f32_decimal = (uint16_t) ((d - (int16_t)d) * POW2_16F); 00035 f.f32_integer = (d < 0 && f.f32_decimal != 0 ? (int16_t)d-1 : (int16_t)d) ; 00036 00037 return f; 00038 } 00039 00040 double f32_to_double(f32 f) 00041 { 00042 double d; 00043 00044 d = f.f32_integer; 00045 d += ((double)f.f32_decimal / POW2_16F); 00046 00047 return d; 00048 }