WebSVN – MLAB – /Modules/Sensors/MAG01A/SW/ Rev HEAD and /Modules/Sensors/MAG01A/SW Rev 2998 – Path Comparison

Problem with comparison.

 /Modules/Sensors/MAG01A/SW/PIC16F887/HMC5883L.c
 ,0 → 1,75
+//------------------------------
+// Low level routines
+//------------------------------
+void hmc5883l_write_reg(int8 reg, int8 data)
+{
+i2c_start();
+i2c_write(HMC5883L_WRT_ADDR);
+i2c_write(reg);
+i2c_write(data);
+i2c_stop();
+}
+//------------------------------
+int8 hmc5883l_read_reg(int8 reg)
+{
+int8 retval;
+i2c_start();
+i2c_write(HMC5883L_WRT_ADDR);
+i2c_write(reg);
+i2c_start();
+i2c_write(HMC5883L_READ_ADDR);
+retval = i2c_read(0);
+i2c_stop();
+return(retval);
+}
+//------------------------------
+typedef struct
+{
+signed int16 x;
+signed int16 y;
+signed int16 z;
+}hmc5883l_result;
+// This global structure holds the values read
+// from the HMC5883L x,y,z registers.
+hmc5883l_result compass = {0,0,0};
+//------------------------------
+void hmc5883l_read_data(void)
+{
+unsigned int8 x_lsb;
+unsigned int8 x_msb;
+unsigned int8 y_lsb;
+unsigned int8 y_msb;
+unsigned int8 z_lsb;
+unsigned int8 z_msb;
+i2c_start();
+i2c_write(HMC5883L_WRT_ADDR);
+i2c_write(HMC5883L_X_MSB_REG);  // Point to X-msb register
+i2c_start();
+i2c_write(HMC5883L_READ_ADDR);
+x_msb = i2c_read();
+x_lsb = i2c_read();
+z_msb = i2c_read();
+z_lsb = i2c_read();
+y_msb = i2c_read();
+y_lsb = i2c_read(0); // do a NACK on last read
+i2c_stop();
+// Combine high and low bytes into 16-bit values.
+compass.x = make16(x_msb, x_lsb);
+compass.y = make16(y_msb, y_lsb);
+compass.z = make16(z_msb, z_lsb);
+}

 /Modules/Sensors/MAG01A/SW/PIC16F887/HMC5883L.h
 ,0 → 1,23
+// i2c slave addresses
+#define HMC5883L_WRT_ADDR  0x3C
+#define HMC5883L_READ_ADDR 0x3D
+// Register addresses
+#define HMC5883L_CFG_A_REG 0x00
+#define HMC5883L_CFG_B_REG 0x01
+#define HMC5883L_MODE_REG  0x02
+#define HMC5883L_X_MSB_REG 0x03
+//Konstanty nastavujici rozsah
+//pro void set_mag_roz (unsigned int8 h)
+#define MAG_ROZ088  0x00
+#define MAG_ROZ130  0x20
+#define MAG_ROZ190  0x40
+#define MAG_ROZ250  0x60
+#define MAG_ROZ400  0x80
+#define MAG_ROZ470  0xA0
+#define MAG_ROZ560  0xC0
+#define MAG_ROZ810  0xE0
+#include "HMC5883L.c"

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.c
 ,0 → 1,47
+#include "main.h"
+#include "HMC5883L.h"
+#include <math.h>
+void main()
+{
+float last,b,anemo_speed;
+unsigned int16 anemo_round=0;
+unsigned int16 i;
+//signed int16 X,Y,Z;
+  setup_adc_ports(NO_ANALOGS|VSS_VDD);
+  setup_adc(ADC_CLOCK_DIV_2);
+  setup_spi(SPI_SS_DISABLED);
+  setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
+  setup_timer_1(T1_DISABLED);
+  setup_timer_2(T2_DISABLED,0,1);
+  setup_ccp1(CCP_OFF);
+  setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard
+  printf("Magnetometr:  \r\n",);
+  printf("(c)mlab JACHO 2013:  \r\n",);
+  printf("X, Y, Z \r\n",);
+// Init the HMC5883L.  Set Mode register for
+// continuous measurements.
+hmc5883l_write_reg(HMC5883L_CFG_A_REG, 0x18);      // no average, maximal update range
+hmc5883l_write_reg(HMC5883L_CFG_B_REG, 0xE0);      // maximal range
+hmc5883l_write_reg(HMC5883L_MODE_REG, 0x00);
+// Continuously read and display the x,y,z results.
+// Wait at least 67 ms between reads, re the HMC5883L data sheet.
+while(TRUE)
+  {
+    hmc5883l_read_data();
+    printf("%6Ld %6Ld %6Ld \n\r", compass.x, compass.y, compass.z);
+    delay_ms(100);
+  }
+}

/Modules/Sensors/MAG01A/SW/PIC16F887/main.cof
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/Modules/Sensors/MAG01A/SW/PIC16F887/main.err
0,0 → 1,7
>>> Warning 202 "main.c" Line 7(7,11): Variable never used: last
>>> Warning 202 "main.c" Line 7(12,13): Variable never used: b
>>> Warning 202 "main.c" Line 7(14,25): Variable never used: anemo_speed
>>> Warning 202 "main.c" Line 8(16,27): Variable never used: anemo_round
>>> Warning 202 "main.c" Line 9(16,17): Variable never used: i
Memory usage: ROM=10% RAM=8% - 10%
0 Errors, 5 Warnings.

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.esym
 ,0 → 1,605
+D G "__PCM__" 0 0 ""4.106""
+D G "__DEVICE__" 0 0 ""
+D G "__DATE__" 0 0 ""17-V-13""
+D G "__TIME__" 0 0 ""12:14:46"" "Standard Header file for the PIC16F887 device ////////////////"
+d G "PIN_A0" 2 20 "40"
+d G "PIN_A1" 2 21 "41"
+d G "PIN_A2" 2 22 "42"
+d G "PIN_A3" 2 23 "43"
+d G "PIN_A4" 2 24 "44"
+d G "PIN_A5" 2 25 "45"
+d G "PIN_A6" 2 26 "46"
+d G "PIN_A7" 2 27 "47"
+d G "PIN_B0" 2 29 "48"
+d G "PIN_B1" 2 30 "49"
+d G "PIN_B2" 2 31 "50"
+d G "PIN_B3" 2 32 "51"
+d G "PIN_B4" 2 33 "52"
+d G "PIN_B5" 2 34 "53"
+d G "PIN_B6" 2 35 "54"
+d G "PIN_B7" 2 36 "55"
+d G "PIN_C0" 2 38 "56"
+d G "PIN_C1" 2 39 "57"
+d G "PIN_C2" 2 40 "58"
+d G "PIN_C3" 2 41 "59"
+d G "PIN_C4" 2 42 "60"
+d G "PIN_C5" 2 43 "61"
+d G "PIN_C6" 2 44 "62"
+d G "PIN_C7" 2 45 "63"
+d G "PIN_D0" 2 47 "64"
+d G "PIN_D1" 2 48 "65"
+d G "PIN_D2" 2 49 "66"
+d G "PIN_D3" 2 50 "67"
+d G "PIN_D4" 2 51 "68"
+d G "PIN_D5" 2 52 "69"
+d G "PIN_D6" 2 53 "70"
+d G "PIN_D7" 2 54 "71"
+d G "PIN_E0" 2 56 "72"
+d G "PIN_E1" 2 57 "73"
+d G "PIN_E2" 2 58 "74"
+d G "PIN_E3" 2 59 "75"
+d G "FALSE" 2 62 "0"
+d G "TRUE" 2 63 "1"
+d G "BYTE" 2 65 "int8"
+d G "BOOLEAN" 2 66 "int1"
+d G "getc" 2 68 "getch"
+d G "fgetc" 2 69 "getch"
+d G "getchar" 2 70 "getch"
+d G "putc" 2 71 "putchar"
+d G "fputc" 2 72 "putchar"
+d G "fgets" 2 73 "gets"
+d G "fputs" 2 74 "puts"
+d G "WDT_FROM_SLEEP" 2 79 "3"
+d G "WDT_TIMEOUT" 2 80 "11"
+d G "MCLR_FROM_SLEEP" 2 81 "19"
+d G "MCLR_FROM_RUN" 2 82 "27"
+d G "NORMAL_POWER_UP" 2 83 "25"
+d G "BROWNOUT_RESTART" 2 84 "26"
+d G "T0_INTERNAL" 2 91 "0"
+d G "T0_EXT_L_TO_H" 2 92 "32"
+d G "T0_EXT_H_TO_L" 2 93 "48"
+d G "T0_DIV_1" 2 95 "8"
+d G "T0_DIV_2" 2 96 "0"
+d G "T0_DIV_4" 2 97 "1"
+d G "T0_DIV_8" 2 98 "2"
+d G "T0_DIV_16" 2 99 "3"
+d G "T0_DIV_32" 2 100 "4"
+d G "T0_DIV_64" 2 101 "5"
+d G "T0_DIV_128" 2 102 "6"
+d G "T0_DIV_256" 2 103 "7"
+d G "T0_8_BIT" 2 106 "0"
+d G "RTCC_INTERNAL" 2 108 "0" "The following are provided for compatibility"
+d G "RTCC_EXT_L_TO_H" 2 109 "32" "with older compiler versions"
+d G "RTCC_EXT_H_TO_L" 2 110 "48"
+d G "RTCC_DIV_1" 2 111 "8"
+d G "RTCC_DIV_2" 2 112 "0"
+d G "RTCC_DIV_4" 2 113 "1"
+d G "RTCC_DIV_8" 2 114 "2"
+d G "RTCC_DIV_16" 2 115 "3"
+d G "RTCC_DIV_32" 2 116 "4"
+d G "RTCC_DIV_64" 2 117 "5"
+d G "RTCC_DIV_128" 2 118 "6"
+d G "RTCC_DIV_256" 2 119 "7"
+d G "RTCC_8_BIT" 2 120 "0"
+d G "WDT_18MS" 2 132 "8"
+d G "WDT_36MS" 2 133 "9"
+d G "WDT_72MS" 2 134 "10"
+d G "WDT_144MS" 2 135 "11"
+d G "WDT_288MS" 2 136 "12"
+d G "WDT_576MS" 2 137 "13"
+d G "WDT_1152MS" 2 138 "14"
+d G "WDT_2304MS" 2 139 "15"
+d G "WDT_ON" 2 143 "0x4100"
+d G "WDT_OFF" 2 144 "0"
+d G "WDT_DIV_16" 2 145 "0x100"
+d G "WDT_DIV_8" 2 146 "0x300"
+d G "WDT_DIV_4" 2 147 "0x500"
+d G "WDT_DIV_2" 2 148 "0x700"
+d G "WDT_TIMES_1" 2 149 "0x900" "Default"
+d G "WDT_TIMES_2" 2 150 "0xB00"
+d G "WDT_TIMES_4" 2 151 "0xD00"
+d G "WDT_TIMES_8" 2 152 "0xF00"
+d G "WDT_TIMES_16" 2 153 "0x1100"
+d G "WDT_TIMES_32" 2 154 "0x1300"
+d G "WDT_TIMES_64" 2 155 "0x1500"
+d G "WDT_TIMES_128" 2 156 "0x1700"
+d G "T1_DISABLED" 2 162 "0"
+d G "T1_INTERNAL" 2 163 "5"
+d G "T1_EXTERNAL" 2 164 "7"
+d G "T1_EXTERNAL_SYNC" 2 165 "3"
+d G "T1_CLK_OUT" 2 167 "8"
+d G "T1_DIV_BY_1" 2 169 "0"
+d G "T1_DIV_BY_2" 2 170 "0x10"
+d G "T1_DIV_BY_4" 2 171 "0x20"
+d G "T1_DIV_BY_8" 2 172 "0x30"
+d G "T1_GATE" 2 174 "0x40"
+d G "T1_GATE_INVERTED" 2 175 "0xC0"
+d G "T2_DISABLED" 2 180 "0"
+d G "T2_DIV_BY_1" 2 181 "4"
+d G "T2_DIV_BY_4" 2 182 "5"
+d G "T2_DIV_BY_16" 2 183 "6"
+d G "CCP_OFF" 2 189 "0"
+d G "CCP_CAPTURE_FE" 2 190 "4"
+d G "CCP_CAPTURE_RE" 2 191 "5"
+d G "CCP_CAPTURE_DIV_4" 2 192 "6"
+d G "CCP_CAPTURE_DIV_16" 2 193 "7"
+d G "CCP_COMPARE_SET_ON_MATCH" 2 194 "8"
+d G "CCP_COMPARE_CLR_ON_MATCH" 2 195 "9"
+d G "CCP_COMPARE_INT" 2 196 "0xA"
+d G "CCP_COMPARE_RESET_TIMER" 2 197 "0xB"
+d G "CCP_PWM" 2 198 "0xC"
+d G "CCP_PWM_PLUS_1" 2 199 "0x1c"
+d G "CCP_PWM_PLUS_2" 2 200 "0x2c"
+d G "CCP_PWM_PLUS_3" 2 201 "0x3c"
+d G "CCP_PWM_H_H" 2 206 "0x0c"
+d G "CCP_PWM_H_L" 2 207 "0x0d"
+d G "CCP_PWM_L_H" 2 208 "0x0e"
+d G "CCP_PWM_L_L" 2 209 "0x0f"
+d G "CCP_PWM_FULL_BRIDGE" 2 211 "0x40"
+d G "CCP_PWM_FULL_BRIDGE_REV" 2 212 "0xC0"
+d G "CCP_PWM_HALF_BRIDGE" 2 213 "0x80"
+d G "CCP_SHUTDOWN_ON_COMP1" 2 215 "0x100000"
+d G "CCP_SHUTDOWN_ON_COMP2" 2 216 "0x200000"
+d G "CCP_SHUTDOWN_ON_COMP" 2 217 "0x300000"
+d G "CCP_SHUTDOWN_ON_INT0" 2 218 "0x400000"
+d G "CCP_SHUTDOWN_ON_COMP1_INT0" 2 219 "0x500000"
+d G "CCP_SHUTDOWN_ON_COMP2_INT0" 2 220 "0x600000"
+d G "CCP_SHUTDOWN_ON_COMP_INT0" 2 221 "0x700000"
+d G "CCP_SHUTDOWN_AC_L" 2 223 "0x000000"
+d G "CCP_SHUTDOWN_AC_H" 2 224 "0x040000"
+d G "CCP_SHUTDOWN_AC_F" 2 225 "0x080000"
+d G "CCP_SHUTDOWN_BD_L" 2 227 "0x000000"
+d G "CCP_SHUTDOWN_BD_H" 2 228 "0x010000"
+d G "CCP_SHUTDOWN_BD_F" 2 229 "0x020000"
+d G "CCP_SHUTDOWN_RESTART" 2 231 "0x80000000"
+d G "CCP_PULSE_STEERING_A" 2 233 "0x01000000"
+d G "CCP_PULSE_STEERING_B" 2 234 "0x02000000"
+d G "CCP_PULSE_STEERING_C" 2 235 "0x04000000"
+d G "CCP_PULSE_STEERING_D" 2 236 "0x08000000"
+d G "CCP_PULSE_STEERING_SYNC" 2 237 "0x10000000"
+d G "SPI_MASTER" 2 245 "0x20"
+d G "SPI_SLAVE" 2 246 "0x24"
+d G "SPI_L_TO_H" 2 247 "0"
+d G "SPI_H_TO_L" 2 248 "0x10"
+d G "SPI_CLK_DIV_4" 2 249 "0"
+d G "SPI_CLK_DIV_16" 2 250 "1"
+d G "SPI_CLK_DIV_64" 2 251 "2"
+d G "SPI_CLK_T2" 2 252 "3"
+d G "SPI_SS_DISABLED" 2 253 "1"
+d G "SPI_SAMPLE_AT_END" 2 255 "0x8000"
+d G "SPI_XMIT_L_TO_H" 2 256 "0x4000"
+d G "UART_ADDRESS" 2 262 "2"
+d G "UART_DATA" 2 263 "4"
+d G "UART_AUTODETECT" 2 264 "8"
+d G "UART_AUTODETECT_NOWAIT" 2 265 "9"
+d G "UART_WAKEUP_ON_RDA" 2 266 "10"
+d G "UART_SEND_BREAK" 2 267 "13"
+d G "NC_NC_NC_NC" 2 273 "0x00"
+d G "NC_NC" 2 274 "0x00"
+d G "CP1_A0_A3" 2 277 "0x00090080"
+d G "CP1_A1_A3" 2 278 "0x000A0081"
+d G "CP1_B3_A3" 2 279 "0x00880082"
+d G "CP1_B1_A3" 2 280 "0x00280083"
+d G "CP1_A0_VREF" 2 281 "0x00010084"
+d G "CP1_A1_VREF" 2 282 "0x00020085"
+d G "CP1_B3_VREF" 2 283 "0x00800086"
+d G "CP1_B1_VREF" 2 284 "0x00200087"
+d G "CP1_OUT_ON_A4" 2 286 "0x00000020"
+d G "CP1_INVERT" 2 287 "0x00000010"
+d G "CP1_ABSOLUTE_VREF" 2 288 "0x20000000"
+d G "CP2_A0_A2" 2 291 "0x00058000"
+d G "CP2_A1_A2" 2 292 "0x00068100"
+d G "CP2_B3_A2" 2 293 "0x00848200"
+d G "CP2_B1_A2" 2 294 "0x00248300"
+d G "CP2_A0_VREF" 2 295 "0x00018400"
+d G "CP2_A1_VREF" 2 296 "0x00028500"
+d G "CP2_B3_VREF" 2 297 "0x00808600"
+d G "CP2_B1_VREF" 2 298 "0x00208700"
+d G "CP2_OUT_ON_A5" 2 300 "0x00002000"
+d G "CP2_INVERT" 2 301 "0x00001000"
+d G "CP2_ABSOLUTE_VREF" 2 302 "0x10000000"
+d G "CP2_T1_SYNC" 2 305 "0x01000000"
+d G "CP2_T1_GATE" 2 306 "0x02000000"
+d G "VREF_LOW" 2 315 "0xa0"
+d G "VREF_HIGH" 2 316 "0x80"
+d G "OSC_31KHZ" 2 322 "1"
+d G "OSC_125KHZ" 2 323 "0x11"
+d G "OSC_250KHZ" 2 324 "0x21"
+d G "OSC_500KHZ" 2 325 "0x31"
+d G "OSC_1MHZ" 2 326 "0x41"
+d G "OSC_2MHZ" 2 327 "0x51"
+d G "OSC_4MHZ" 2 328 "0x61"
+d G "OSC_8MHZ" 2 329 "0x71"
+d G "OSC_INTRC" 2 330 "1"
+d G "OSC_NORMAL" 2 331 "0"
+d G "OSC_STATE_STABLE" 2 333 "4"
+d G "OSC_31KHZ_STABLE" 2 334 "2"
+d G "ADC_OFF" 2 342 "0" "ADC Off"
+d G "ADC_CLOCK_DIV_2" 2 343 "0x100"
+d G "ADC_CLOCK_DIV_8" 2 344 "0x40"
+d G "ADC_CLOCK_DIV_32" 2 345 "0x80"
+d G "ADC_CLOCK_INTERNAL" 2 346 "0xc0" "Internal 2-6us"
+d G "sAN0" 2 350 "1" "| A0"
+d G "sAN1" 2 351 "2" "| A1"
+d G "sAN2" 2 352 "4" "| A2"
+d G "sAN3" 2 353 "8" "| A3"
+d G "sAN4" 2 354 "16" "| A5"
+d G "sAN5" 2 355 "32" "| E0"
+d G "sAN6" 2 356 "64" "| E1"
+d G "sAN7" 2 357 "128" "| E2"
+d G "sAN8" 2 358 "0x10000" "| B2"
+d G "sAN9" 2 359 "0x20000" "| B3"
+d G "sAN10" 2 360 "0x40000" "| B1"
+d G "sAN11" 2 361 "0x80000" "| B4"
+d G "sAN12" 2 362 "0x100000" "| B0"
+d G "sAN13" 2 363 "0x200000" "| B5"
+d G "NO_ANALOGS" 2 364 "0" "None"
+d G "ALL_ANALOG" 2 365 "0x1F00FF" "A0 A1 A2 A3 A5 E0 E1 E2 B0 B1 B2 B3 B4 B5"
+d G "VSS_VDD" 2 368 "0x0000" "| Range 0-Vdd"
+d G "VSS_VREF" 2 369 "0x1000" "| Range 0-Vref"
+d G "VREF_VREF" 2 370 "0x3000" "| Range Vref-Vref"
+d G "VREF_VDD" 2 371 "0x2000" "| Range Vref-Vdd"
+d G "ADC_START_AND_READ" 2 375 "7" "This is the default if nothing is specified"
+d G "ADC_START_ONLY" 2 376 "1"
+d G "ADC_READ_ONLY" 2 377 "6"
+d G "L_TO_H" 2 389 "0x40"
+d G "H_TO_L" 2 390 "0"
+d G "GLOBAL" 2 392 "0x0BC0"
+d G "INT_RTCC" 2 393 "0x000B20"
+d G "INT_RB" 2 394 "0x01FF0B08"
+d G "INT_EXT_L2H" 2 395 "0x50000B10"
+d G "INT_EXT_H2L" 2 396 "0x60000B10"
+d G "INT_EXT" 2 397 "0x000B10"
+d G "INT_AD" 2 398 "0x008C40"
+d G "INT_TBE" 2 399 "0x008C10"
+d G "INT_RDA" 2 400 "0x008C20"
+d G "INT_TIMER1" 2 401 "0x008C01"
+d G "INT_TIMER2" 2 402 "0x008C02"
+d G "INT_CCP1" 2 403 "0x008C04"
+d G "INT_CCP2" 2 404 "0x008D01"
+d G "INT_SSP" 2 405 "0x008C08"
+d G "INT_BUSCOL" 2 406 "0x008D08"
+d G "INT_EEPROM" 2 407 "0x008D10"
+d G "INT_TIMER0" 2 408 "0x000B20"
+d G "INT_OSC_FAIL" 2 409 "0x008D80"
+d G "INT_COMP" 2 410 "0x008D20"
+d G "INT_COMP2" 2 411 "0x008D40"
+d G "INT_ULPWU" 2 412 "0x008D04"
+d G "INT_RB0" 2 413 "0x0010B08"
+d G "INT_RB1" 2 414 "0x0020B08"
+d G "INT_RB2" 2 415 "0x0040B08"
+d G "INT_RB3" 2 416 "0x0080B08"
+d G "INT_RB4" 2 417 "0x0100B08"
+d G "INT_RB5" 2 418 "0x0200B08"
+d G "INT_RB6" 2 419 "0x0400B08"
+d G "INT_RB7" 2 420 "0x0800B08"
+D G "HMC5883L_WRT_ADDR" 3 2 "0x3C"
+D G "HMC5883L_READ_ADDR" 3 3 "0x3D"
+D G "HMC5883L_CFG_A_REG" 3 6 "0x00"
+D G "HMC5883L_CFG_B_REG" 3 7 "0x01"
+D G "HMC5883L_MODE_REG" 3 8 "0x02"
+D G "HMC5883L_X_MSB_REG" 3 9 "0x03"
+D G "MAG_ROZ088" 3 13 "0x00"
+D G "MAG_ROZ130" 3 14 "0x20"
+D G "MAG_ROZ190" 3 15 "0x40"
+D G "MAG_ROZ250" 3 16 "0x60"
+D G "MAG_ROZ400" 3 17 "0x80"
+D G "MAG_ROZ470" 3 18 "0xA0"
+D G "MAG_ROZ560" 3 19 "0xC0"
+D G "MAG_ROZ810" 3 20 "0xE0"
+C L "hmc5883l_write_reg" 4 2 1 "FUNCTION"
+F G "hmc5883l_write_reg" 4 4 "void()"
+V L "reg" 4 4 "int8"
+V L "data" 4 4 "int8"
+F G "hmc5883l_read_reg" 4 14 "int8()"
+V L "reg" 4 14 "int8"
+V L "retval" 4 16 "int8"
+T G "hmc5883l_result" 4 35 "{sint16 x,sint16 y,sint16 z}" "This global structure holds the values read"
+V G "compass" 4 39 "hmc5883l_result"
+F G "hmc5883l_read_data" 4 42 "void()"
+V L "x_lsb" 4 44 "int8"
+V L "x_msb" 4 45 "int8"
+V L "y_lsb" 4 47 "int8"
+V L "y_msb" 4 48 "int8"
+V L "z_lsb" 4 50 "int8"
+V L "z_msb" 4 51 "int8"
+C L "hmc5883l_read_data" 4 2 1 "FUNCTION"
+C L "hmc5883l_read_data" 4 2 1 "FUNCTION"
+C L "hmc5883l_read_data" 4 2 1 "FUNCTION"
+D G "MATH_H" 5 21 ""
+D G "PI" 5 26 "3.1415926535897932"
+D G "SQRT2" 5 29 "1.4142135623730950"
+C L "CEIL_FLOOR" 5 2 3 "FUNCTION"
+F G "CEIL_FLOOR" 5 36 "float()"
+V L "x" 5 36 "float"
+V L "n" 5 36 "int8"
+V L "y" 5 38 "float"
+V L "res" 5 38 "float"
+V L "l" 5 39 "int16"
+V L "s" 5 40 "int1"
+C L "floor" 5 2 5 "FUNCTION"
+F G "floor" 5 192 "float()"
+V L "x" 5 192 "float"
+C L "ceil" 5 2 5 "FUNCTION"
+F G "ceil" 5 218 "float()"
+V L "x" 5 218 "float"
+D G "fabs" 5 244 "abs"
+C L "fmod" 5 2 6 "FUNCTION"
+F G "fmod" 5 256 "float()"
+V L "x" 5 256 "float"
+V L "y" 5 256 "float"
+V L "i" 5 258 "float"
+D G "LN2" 5 319 "0.6931471805599453"
+V G "pe" 5 321 "float[6]"
+F G "exp" 5 325 "float()"
+V L "x" 5 325 "float"
+V L "y" 5 327 "float"
+V L "res" 5 327 "float"
+V L "r" 5 327 "float"
+V L "n" 5 331 "sint8"
+V L "s" 5 332 "int1"
+C L "exp" 5 2 1 "FUNCTION"
+V G "pl" 5 496 "float[4]"
+V G "ql" 5 497 "float[4]"
+C L "log" 5 2 3 "FUNCTION"
+F G "log" 5 505 "float()"
+V L "x" 5 505 "float"
+V L "y" 5 507 "float"
+V L "res" 5 507 "float"
+V L "r" 5 507 "float"
+V L "y2" 5 507 "float"
+V L "n" 5 511 "sint8"
+C L "log" 5 2 1 "FUNCTION"
+D G "LN10" 5 729 "2.3025850929940456"
+C L "log10" 5 2 3 "FUNCTION"
+F G "log10" 5 737 "float()"
+V L "x" 5 737 "float"
+V L "r" 5 739 "float"
+C L "modf" 5 2 8 "FUNCTION"
+F G "modf" 5 778 "float()"
+V L "value" 5 778 "float"
+V L "iptr" 5 778 "*float"
+C L "pwr" 5 2 6 "FUNCTION"
+F G "pwr" 5 806 "float()"
+V L "x" 5 806 "float"
+V L "y" 5 806 "float"
+C L "pow" 5 2 7 "FUNCTION"
+F G "pow" 5 869 "float()"
+V L "x" 5 869 "float"
+V L "y" 5 869 "float"
+C L "sqrt" 5 2 5 "FUNCTION"
+F G "sqrt" 5 930 "float()"
+V L "x" 5 930 "float"
+V L "y" 5 932 "float"
+V L "res" 5 932 "float"
+V L "p" 5 936 "*int8"
+D G "PI_DIV_BY_TWO" 5 1125 "1.5707963267948966"
+C L "cos" 5 2 3 "FUNCTION"
+F G "cos" 5 1136 "float()"
+V L "x" 5 1136 "float"
+V L "y" 5 1138 "float"
+V L "t" 5 1138 "float"
+V L "t2" 5 1138 "float"
+V L "quad" 5 1139 "int8"
+V L "i" 5 1139 "int8"
+V L "frac" 5 1140 "float"
+V L "p" 5 1141 "float[6]" "by the series definition for cosine"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 2 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "cos" 5 2 1 "FUNCTION"
+C L "sin" 5 2 5 "FUNCTION"
+F G "sin" 5 1278 "float()"
+V L "x" 5 1278 "float"
+C L "tan" 5 2 5 "FUNCTION"
+F G "tan" 5 1304 "float()"
+V L "x" 5 1304 "float"
+V L "c" 5 1306 "float"
+V L "s" 5 1306 "float"
+V G "pas" 5 1344 "float[3]"
+V G "qas" 5 1345 "float[3]"
+F G "ASIN_COS" 5 1347 "float()"
+V L "x" 5 1347 "float"
+V L "n" 5 1347 "int8"
+V L "y" 5 1349 "float"
+V L "res" 5 1349 "float"
+V L "r" 5 1349 "float"
+V L "y2" 5 1349 "float"
+V L "s" 5 1350 "int1"
+C L "ASIN_COS" 5 2 1 "FUNCTION"
+C L "ASIN_COS" 5 2 1 "FUNCTION"
+C L "asin" 5 2 5 "FUNCTION"
+F G "asin" 5 1493 "float()"
+V L "x" 5 1493 "float"
+V L "r" 5 1495 "float"
+C L "acos" 5 2 5 "FUNCTION"
+F G "acos" 5 1527 "float()"
+V L "x" 5 1527 "float"
+V L "r" 5 1529 "float"
+V G "pat" 5 1555 "float[4]"
+V G "qat" 5 1556 "float[4]"
+C L "atan" 5 2 3 "FUNCTION"
+F G "atan" 5 1564 "float()"
+V L "x" 5 1564 "float"
+V L "y" 5 1566 "float"
+V L "res" 5 1566 "float"
+V L "r" 5 1566 "float"
+V L "s" 5 1567 "int1"
+V L "flag" 5 1567 "int1"
+C L "atan" 5 2 1 "FUNCTION"
+C L "atan2" 5 2 7 "FUNCTION"
+F G "atan2" 5 1697 "float()"
+V L "y" 5 1697 "float"
+V L "x" 5 1697 "float"
+V L "z" 5 1699 "float"
+V L "sign" 5 1700 "int1"
+V L "quad" 5 1701 "int8"
+C L "atan2" 5 2 1 "FUNCTION"
+C L "atan2" 5 2 1 "FUNCTION"
+C L "cosh" 5 2 7 "FUNCTION"
+F G "cosh" 5 1919 "float()"
+V L "x" 5 1919 "float"
+C L "sinh" 5 2 6 "FUNCTION"
+F G "sinh" 5 1946 "float()"
+V L "x" 5 1946 "float"
+C L "tanh" 5 2 6 "FUNCTION"
+F G "tanh" 5 1976 "float()"
+V L "x" 5 1976 "float"
+D G "LOG2" 5 2006 ".30102999566398119521"
+F G "frexp" 5 2007 "float()"
+V L "x" 5 2007 "float"
+V L "exp" 5 2007 "*sint8"
+V L "res" 5 2009 "float"
+V L "sign" 5 2010 "int1"
+C L "ldexp" 5 2 6 "FUNCTION"
+F G "ldexp" 5 2152 "float()"
+V L "value" 5 2152 "float"
+V L "exp" 5 2152 "sint8"
+C L "MAIN" 5 2 2 "FUNCTION"
+F G "MAIN" 0 5 "void()"
+V L "last" 0 7 "float"
+V L "b" 0 7 "float"
+V L "anemo_speed" 0 7 "float"
+V L "anemo_round" 0 8 "int16"
+V L "i" 0 9 "int16" "signed int16 X,Y,Z;"
+C L "MAIN" 0 19 1 "FUNCTION"
+C L "MAIN" 0 19 2 "FUNCTION"
+C L "MAIN" 0 19 1 "FUNCTION"
+C L "MAIN" 0 19 1 "FUNCTION"
+C L "MAIN" 0 19 2 "FUNCTION"
+F B "reset_cpu" 0 0
+F B "abs" 1 0
+F B "sleep_ulpwu" 1 0
+F B "sleep" 0 0
+F B "delay_cycles" 1 0
+F B "read_bank" 2 0
+F B "write_bank" 3 0
+F B "shift_left" 2 2
+F B "shift_right" 2 2
+F B "rotate_left" 2 0
+F B "rotate_right" 2 0
+F B "_mul" 2 0
+F B "memset" 3 0
+F B "isamoung" 2 0
+F B "isamong" 2 0
+F B "bit_set" 2 0
+F B "bit_clear" 2 0
+F B "bit_test" 2 0
+F B "toupper" 1 0
+F B "tolower" 1 0
+F B "swap" 1 0
+F B "printf" 1 255
+F B "fprintf" 1 255
+F B "sprintf" 1 255
+F B "make8" 2 0
+F B "make16" 2 0
+F B "make32" 1 255
+F B "label_address" 1 1
+F B "goto_address" 1 0
+F B "_va_arg" 1 0
+F B "offsetofbit" 2 2
+F B "enable_interrupts" 1 0
+F B "disable_interrupts" 1 0
+F B "interrupt_active" 1 0
+F B "clear_interrupt" 1 0
+F B "jump_to_isr" 1 0
+F B "ext_int_edge" 1 2
+F B "read_eeprom" 1 0
+F B "write_eeprom" 2 0
+F B "read_program_eeprom" 1 0
+F B "write_program_eeprom" 2 0
+F B "write_program_memory" 4 0
+F B "write_program_memory8" 4 0
+F B "read_program_memory" 4 0
+F B "read_program_memory8" 4 0
+F B "erase_program_eeprom" 1 0
+F B "strcpy" 2 0
+F B "memcpy" 3 0
+F B "strstr100" 2 0
+F B "output_high" 1 0
+F B "output_low" 1 0
+F B "input" 1 0
+F B "input_state" 1 0
+F B "output_float" 1 0
+F B "output_drive" 1 0
+F B "output_bit" 1 1
+F B "output_toggle" 1 0
+F B "output_a" 1 0
+F B "output_b" 1 0
+F B "output_c" 1 0
+F B "output_d" 1 0
+F B "output_e" 1 0
+F B "input_a" 0 0
+F B "input_b" 0 0
+F B "input_c" 0 0
+F B "input_d" 0 0
+F B "input_e" 0 0
+F B "set_tris_a" 1 0
+F B "set_tris_b" 1 0
+F B "set_tris_c" 1 0
+F B "set_tris_d" 1 0
+F B "set_tris_e" 1 0
+F B "get_tris_a" 0 0
+F B "get_tris_b" 0 0
+F B "get_tris_c" 0 0
+F B "get_tris_d" 0 0
+F B "get_tris_e" 0 0
+F B "input_change_a" 0 0
+F B "input_change_b" 0 0
+F B "input_change_c" 0 0
+F B "input_change_d" 0 0
+F B "input_change_e" 0 0
+F B "port_b_pullups" 1 0
+F B "setup_counters" 2 0
+F B "setup_wdt" 1 0
+F B "restart_cause" 0 0
+F B "restart_wdt" 0 0
+F B "get_rtcc" 0 0
+F B "set_rtcc" 1 0
+F B "get_timer0" 0 0
+F B "set_timer0" 1 0
+F B "setup_comparator" 1 0
+F B "setup_port_a" 1 0
+F B "setup_adc_ports" 1 0
+F B "setup_adc" 1 0
+F B "set_adc_channel" 1 0
+F B "read_adc" 0 1
+F B "adc_done" 0 0
+F B "setup_timer_0" 1 0
+F B "setup_vref" 1 0
+F B "setup_timer_1" 1 0
+F B "get_timer1" 0 0
+F B "set_timer1" 1 0
+F B "setup_timer_2" 3 0
+F B "get_timer2" 0 0
+F B "set_timer2" 1 0
+F B "setup_ccp1" 1 2
+F B "set_pwm1_duty" 1 0
+F B "setup_ccp2" 1 0
+F B "set_pwm2_duty" 1 0
+F B "setup_oscillator" 1 2
+F B "setup_spi" 1 0
+F B "spi_read" 0 1
+F B "spi_write" 1 0
+F B "spi_data_is_in" 0 0
+F B "setup_spi2" 1 0
+F B "spi_read2" 0 1
+F B "spi_write2" 1 0
+F B "spi_data_is_in2" 0 0
+F B "brownout_enable" 1 0
+F B "delay_ms" 1 0
+F B "delay_us" 1 0
+F B "i2c_read" 0 2
+F B "i2c_write" 1 2
+F B "i2c_start" 0 2
+F B "i2c_stop" 0 1
+F B "i2c_isr_state" 0 1
+F B "putchar" 1 2
+F B "puts" 1 2
+F B "getch" 0 1
+F B "gets" 1 3
+F B "kbhit" 0 1

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.h
 ,0 → 1,21
+#include <16F887.h>
+#device adc=8
+#FUSES NOWDT                    //No Watch Dog Timer
+#FUSES INTRC                    //Internal RC Osc
+#FUSES NOPUT                    //No Power Up Timer
+#FUSES MCLR                     //Master Clear pin enabled
+#FUSES NOPROTECT                //Code not protected from reading
+#FUSES NOCPD                    //No EE protection
+#FUSES NOBROWNOUT               //No brownout reset
+#FUSES IESO                     //Internal External Switch Over mode enabled
+#FUSES FCMEN                    //Fail-safe clock monitor enabled
+#FUSES NOLVP                    //No low voltage prgming, B3(PIC16) or B5(PIC18) used for I/O
+#FUSES NODEBUG                  //No Debug mode for ICD
+#FUSES NOWRT                    //Program memory not write protected
+#FUSES BORV40                   //Brownout reset at 4.0V
+#use delay(clock=8000000)
+#use i2c(Master,Slow,sda=PIN_C4,scl=PIN_C3)
+#use rs232(baud=9600,parity=N,xmit=PIN_C7,rcv=PIN_C6,bits=8) //rcv TXD xmit RXD

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.hex
 ,0 → 1,104
+:1000000002308A00662A0000CD306737653AEF3645
+:10001000653A721D20100D050000A831A936EC309C
+:100020006210CA2043244F103218B1193A10A006AA
+:100030000A005816A02C2C105A100D050001A01310
+:10004000200883168700831287130830F8002828B9
+:100050000000F8173928F813C00C03188717031C81
+:100060008713781739287813F80B2C2837280000C5
+:1000700087173F308400840B3B280000F81B2B2897
+:10008000781B33280800831603178C170C14000004
+:10009000000083120C087F39031987280313B70067
+:1000A00003170D080313B80003170F080313B90053
+:1000B0003708C0001F20380803178D0003133908C4
+:1000C00003178F0083168C170C1400000000831296
+:1000D0000C0D0E0D7F39031987280313B700031782
+:1000E0000D080313B80003170F080313B9003708EE
+:1000F000C0001F20380803178D00031339080317A9
+:100100008F008D0A03198F0A031343280317031363
+:1001100008000830F80000008711A011200883169D
+:10012000870000008312BD0D0712031C9D282016B6
+:10013000200883168700A128831220122008831626
+:10014000870000008312A015200883168700831201
+:10015000871DA828F80B8B2800008711A011200804
+:10016000831687000000831220162008831687005C
+:10017000000000008312A015200883168700831258
+:10018000871DC028F8010000071A78148711A011F4
+:100190002008831687008312071220122008831676
+:1001A00087008312080020162008831687000000AD
+:1001B0008312A015200883168700000083120712FF
+:1001C0002012200883168700000083128711A011D7
+:1001D0002008831687003C308312BD008920370831
+:1001E000BD0089203808BD00892020122008831610
+:1001F000870000008312A015200883168700831251
+:10020000871D0029000004290000201620088316FD
+:1002100087000000831208000830BE007708BF0086
+:10022000201620088316870000008312A0152008DE
+:10023000831687008312871D1B29071A0314071EC4
+:100240000310F80D0000A011200883168700831208
+:100250008711BE0B10292016200883168700000086
+:10026000831207123F0803193A2920122008831627
+:10027000870083120000A0152008831687008312D0
+:10028000871D402900008711A011200883168700D0
+:1002900000008312071220122008831687008312A1
+:1002A0000800201620088316870000008312A0157E
+:1002B00020088316870000008312071220122008EE
+:1002C00083168700000083128711A011200883166F
+:1002D00087003C308312BD0089200330BD00892097
+:1002E000201620088316870000008312A01520081E
+:1002F0008316870000008312871D7C2907122012B5
+:10030000200883168700000083128711A01120089F
+:10031000831687003D308312BD0089200130F7002D
+:100320000C217808B8000130F7000C217808B700DC
+:100330000130F7000C217808BC000130F7000C21D7
+:100340007808BB000130F7000C217808BA00F701EB
+:100350000C217808B90020122008831687000000BD
+:100360008312A0152008831687008312871DB629E3
+:100370000000BA290000201620088316870000001C
+:1003800083123808A2003708A1003A08A4003908EF
+:10039000A3003C08A6003B08A5008A110A12F62A11
+:1003A000BF010408BE003F10831B3F14B81FE029A3
+:1003B000BE173E1EBE0AB709B809B70A0319B80A24
+:1003C000380EF038BA00BA07E23EBB00323EBD003C
+:1003D00038080F39BB07BB07BD07E93EBC00BC07A7
+:1003E000BC07370E0F39BC07BD07BC0DBD0DBD09DD
+:1003F000BD0D37080F39BD07BA0D0730B9000A30F7
+:10040000BD07BC03031C002ABC07BB03031C042A52
+:10041000BB07BA03031C082ABA07B903031C0C2A3A
+:1004200039308400831307303E053E1384033E05B4
+:10043000031D212A3E1A840A3E1A212A2030F70081
+:100440003E2A84073D30040203193E170008F700D6
+:10045000031D322A3E1B322A3E1A4C2ABE19322A6A
+:1004600020303D2ABE1F3A2A2D30F70084033E1368
+:10047000BE133E2ABE153E123030F707B8010408FD
+:10048000B7003810831B38147708C0001F203708C6
+:100490008400831338188317840A3E1F222A080019
+:1004A00037308400831300080319632A0230F800F0
+:1004B000F701F70B592AF80B582A9730F700F70B7A
+:1004C0005F2A800B562A8A110A121D2B840183137E
+:1004D0001F308305713083168F000F088312A0131D
+:1004E00020088316870083128717831603170908CD
+:1004F000C039890003131F129F12003003178800B0
+:100500008312870188018901FF300313A000A10134
+:10051000A201A301A401A501A601B401B3018316A0
+:1005200003170908C039890003131F129F120030F6
+:1005300003178800831203131F139F1383169F133F
+:1005400083121F149412A0122008831687008312AE
+:1005500020162008831687008312A0112008831616
+:100560008700013083129400003083169400010844
+:10057000C73908388100831290010030F8009200DA
+:1005800000308316920083122015200883168700FE
+:100590008312970183169B019C0101309D008312F9
+:1005A000031787018801890104308D0000308F0016
+:1005B000031343200D3003178D0000308F00031309
+:1005C0004320193003178D0000308F0003134320A0
+:1005D000B7011830B800D3200130B700E030B800C0
+:1005E000D3200230B700B801D32051290030840055
+:1005F0002208B8002108B700D0212030C0001F20F9
+:10060000003084002408B8002308B700D02120302F
+:10061000C0001F20003084002608B8002508B7005D
+:10062000D0212030C0001F200A30C0001F200D3014
+:0E063000C0001F206430B700502AF52A630076
+:04400E00F52CFF3F4F
+:00000001FF
+;PIC16F887
+;CRC=17FE  CREATED="17-V-13 12:14"

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.lst
 ,0 → 1,2941
+CCS PCM C Compiler, Version 4.106, 47914               17-V-13 12:14
+               Filename: Z:\home\kaklik\svnMLAB\Modules\Sensors\MAG01A\SW\PIC16F887\main.lst
+               ROM used: 799 words (10%)
+                         Largest free fragment is 2048
+               RAM used: 28 (8%) at main() level
+(10%) worst case
+               Stack:    2 locations
+*
+:  MOVLW  02
+:  MOVWF  0A
+:  GOTO   266
+:  NOP
+.................... #include "main.h"
+.................... #include <16F887.h>
+.................... //////// Standard Header file for the PIC16F887 device ////////////////
+.................... #device PIC16F887
+.................... #list
+....................
+.................... #device adc=8
+....................
+.................... #FUSES NOWDT                    //No Watch Dog Timer
+.................... #FUSES INTRC                    //Internal RC Osc
+.................... #FUSES NOPUT                    //No Power Up Timer
+.................... #FUSES MCLR                     //Master Clear pin enabled
+.................... #FUSES NOPROTECT                //Code not protected from reading
+.................... #FUSES NOCPD                    //No EE protection
+.................... #FUSES NOBROWNOUT               //No brownout reset
+.................... #FUSES IESO                     //Internal External Switch Over mode enabled
+.................... #FUSES FCMEN                    //Fail-safe clock monitor enabled
+.................... #FUSES NOLVP                    //No low voltage prgming, B3(PIC16) or B5(PIC18) used for I/O
+.................... #FUSES NODEBUG                  //No Debug mode for ICD
+.................... #FUSES NOWRT                    //Program memory not write protected
+.................... #FUSES BORV40                   //Brownout reset at 4.0V
+....................
+.................... #use delay(clock=8000000)
+*
+:  MOVLW  37
+:  MOVWF  04
+:  BCF    03.7
+:  MOVF   00,W
+:  BTFSC  03.2
+:  GOTO   263
+:  MOVLW  02
+:  MOVWF  78
+:  CLRF   77
+:  DECFSZ 77,F
+A:  GOTO   259
+B:  DECFSZ 78,F
+C:  GOTO   258
+D:  MOVLW  97
+E:  MOVWF  77
+F:  DECFSZ 77,F
+:  GOTO   25F
+:  DECFSZ 00,F
+:  GOTO   256
+:  BCF    0A.3
+:  BCF    0A.4
+:  GOTO   31D (RETURN)
+.................... #use i2c(Master,Slow,sda=PIN_C4,scl=PIN_C3)
+*
+:  MOVLW  08
+A:  MOVWF  78
+B:  NOP
+C:  BCF    07.3
+D:  BCF    20.3
+E:  MOVF   20,W
+F:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  RLF    3D,F
+:  BCF    07.4
+:  BTFSS  03.0
+:  GOTO   09D
+:  BSF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+A:  MOVWF  07
+B:  GOTO   0A1
+C:  BCF    03.5
+D:  BCF    20.4
+E:  MOVF   20,W
+F:  BSF    03.5
+A0:  MOVWF  07
+A1:  NOP
+A2:  BCF    03.5
+A3:  BSF    20.3
+A4:  MOVF   20,W
+A5:  BSF    03.5
+A6:  MOVWF  07
+A7:  BCF    03.5
+A8:  BTFSS  07.3
+A9:  GOTO   0A8
+AA:  DECFSZ 78,F
+AB:  GOTO   08B
+AC:  NOP
+AD:  BCF    07.3
+AE:  BCF    20.3
+AF:  MOVF   20,W
+B0:  BSF    03.5
+B1:  MOVWF  07
+B2:  NOP
+B3:  BCF    03.5
+B4:  BSF    20.4
+B5:  MOVF   20,W
+B6:  BSF    03.5
+B7:  MOVWF  07
+B8:  NOP
+B9:  NOP
+BA:  BCF    03.5
+BB:  BSF    20.3
+BC:  MOVF   20,W
+BD:  BSF    03.5
+BE:  MOVWF  07
+BF:  BCF    03.5
+C0:  BTFSS  07.3
+C1:  GOTO   0C0
+C2:  CLRF   78
+C3:  NOP
+C4:  BTFSC  07.4
+C5:  BSF    78.0
+C6:  BCF    07.3
+C7:  BCF    20.3
+C8:  MOVF   20,W
+C9:  BSF    03.5
+CA:  MOVWF  07
+CB:  BCF    03.5
+CC:  BCF    07.4
+CD:  BCF    20.4
+CE:  MOVF   20,W
+CF:  BSF    03.5
+D0:  MOVWF  07
+D1:  BCF    03.5
+D2:  RETURN
+*
+C:  MOVLW  08
+D:  MOVWF  3E
+E:  MOVF   77,W
+F:  MOVWF  3F
+:  BSF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  BSF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+A:  BCF    03.5
+B:  BTFSS  07.3
+C:  GOTO   11B
+D:  BTFSC  07.4
+E:  BSF    03.0
+F:  BTFSS  07.4
+:  BCF    03.0
+:  RLF    78,F
+:  NOP
+:  BCF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  BCF    03.5
+:  BCF    07.3
+:  DECFSZ 3E,F
+A:  GOTO   110
+B:  BSF    20.4
+C:  MOVF   20,W
+D:  BSF    03.5
+E:  MOVWF  07
+F:  NOP
+:  BCF    03.5
+:  BCF    07.4
+:  MOVF   3F,W
+:  BTFSC  03.2
+:  GOTO   13A
+:  BCF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  BCF    03.5
+A:  NOP
+B:  BSF    20.3
+C:  MOVF   20,W
+D:  BSF    03.5
+E:  MOVWF  07
+F:  BCF    03.5
+:  BTFSS  07.3
+:  GOTO   140
+:  NOP
+:  BCF    07.3
+:  BCF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+A:  BCF    07.4
+B:  BCF    20.4
+C:  MOVF   20,W
+D:  BSF    03.5
+E:  MOVWF  07
+F:  BCF    03.5
+:  RETURN
+.................... #use rs232(baud=9600,parity=N,xmit=PIN_C7,rcv=PIN_C6,bits=8) //rcv TXD xmit RXD
+*
+F:  BCF    20.7
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  BCF    03.5
+:  BCF    07.7
+:  MOVLW  08
+:  MOVWF  78
+:  GOTO   028
+:  NOP
+:  BSF    78.7
+A:  GOTO   039
+B:  BCF    78.7
+C:  RRF    40,F
+D:  BTFSC  03.0
+E:  BSF    07.7
+F:  BTFSS  03.0
+:  BCF    07.7
+:  BSF    78.6
+:  GOTO   039
+:  BCF    78.6
+:  DECFSZ 78,F
+:  GOTO   02C
+:  GOTO   037
+:  NOP
+:  BSF    07.7
+:  MOVLW  3F
+A:  MOVWF  04
+B:  DECFSZ 04,F
+C:  GOTO   03B
+D:  NOP
+E:  BTFSC  78.7
+F:  GOTO   02B
+:  BTFSC  78.6
+:  GOTO   033
+:  RETURN
+....................
+....................
+.................... #include "HMC5883L.h"
+.................... // i2c slave addresses
+.................... #define HMC5883L_WRT_ADDR  0x3C
+.................... #define HMC5883L_READ_ADDR 0x3D
+....................
+.................... // Register addresses
+.................... #define HMC5883L_CFG_A_REG 0x00
+.................... #define HMC5883L_CFG_B_REG 0x01
+.................... #define HMC5883L_MODE_REG  0x02
+.................... #define HMC5883L_X_MSB_REG 0x03
+....................
+.................... //Konstanty nastavujici rozsah
+.................... //pro void set_mag_roz (unsigned int8 h)
+.................... #define MAG_ROZ088  0x00
+.................... #define MAG_ROZ130  0x20
+.................... #define MAG_ROZ190  0x40
+.................... #define MAG_ROZ250  0x60
+.................... #define MAG_ROZ400  0x80
+.................... #define MAG_ROZ470  0xA0
+.................... #define MAG_ROZ560  0xC0
+.................... #define MAG_ROZ810  0xE0
+....................
+....................
+.................... #include "HMC5883L.c"
+.................... //------------------------------
+.................... // Low level routines
+.................... //------------------------------
+.................... void hmc5883l_write_reg(int8 reg, int8 data)
+.................... {
+.................... i2c_start();
+*
+D3:  BSF    20.4
+D4:  MOVF   20,W
+D5:  BSF    03.5
+D6:  MOVWF  07
+D7:  NOP
+D8:  BCF    03.5
+D9:  BSF    20.3
+DA:  MOVF   20,W
+DB:  BSF    03.5
+DC:  MOVWF  07
+DD:  NOP
+DE:  BCF    03.5
+DF:  BCF    07.4
+E0:  BCF    20.4
+E1:  MOVF   20,W
+E2:  BSF    03.5
+E3:  MOVWF  07
+E4:  NOP
+E5:  BCF    03.5
+E6:  BCF    07.3
+E7:  BCF    20.3
+E8:  MOVF   20,W
+E9:  BSF    03.5
+EA:  MOVWF  07
+.................... i2c_write(HMC5883L_WRT_ADDR);
+EB:  MOVLW  3C
+EC:  BCF    03.5
+ED:  MOVWF  3D
+EE:  CALL   089
+.................... i2c_write(reg);
+EF:  MOVF   37,W
+F0:  MOVWF  3D
+F1:  CALL   089
+.................... i2c_write(data);
+F2:  MOVF   38,W
+F3:  MOVWF  3D
+F4:  CALL   089
+.................... i2c_stop();
+F5:  BCF    20.4
+F6:  MOVF   20,W
+F7:  BSF    03.5
+F8:  MOVWF  07
+F9:  NOP
+FA:  BCF    03.5
+FB:  BSF    20.3
+FC:  MOVF   20,W
+FD:  BSF    03.5
+FE:  MOVWF  07
+FF:  BCF    03.5
+:  BTFSS  07.3
+:  GOTO   100
+:  NOP
+:  GOTO   104
+:  NOP
+:  BSF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+.................... }
+A:  BCF    03.5
+B:  RETURN
+....................
+.................... //------------------------------
+.................... int8 hmc5883l_read_reg(int8 reg)
+.................... {
+.................... int8 retval;
+....................
+.................... i2c_start();
+.................... i2c_write(HMC5883L_WRT_ADDR);
+.................... i2c_write(reg);
+.................... i2c_start();
+.................... i2c_write(HMC5883L_READ_ADDR);
+.................... retval = i2c_read(0);
+.................... i2c_stop();
+....................
+.................... return(retval);
+.................... }
+....................
+.................... //------------------------------
+.................... typedef struct
+.................... {
+.................... signed int16 x;
+.................... signed int16 y;
+.................... signed int16 z;
+.................... }hmc5883l_result;
+....................
+.................... // This global structure holds the values read
+.................... // from the HMC5883L x,y,z registers.
+.................... hmc5883l_result compass = {0,0,0};
+*
+:  CLRF   21
+:  CLRF   22
+:  CLRF   23
+A:  CLRF   24
+B:  CLRF   25
+C:  CLRF   26
+....................
+.................... //------------------------------
+.................... void hmc5883l_read_data(void)
+.................... {
+.................... unsigned int8 x_lsb;
+.................... unsigned int8 x_msb;
+....................
+.................... unsigned int8 y_lsb;
+.................... unsigned int8 y_msb;
+....................
+.................... unsigned int8 z_lsb;
+.................... unsigned int8 z_msb;
+....................
+.................... i2c_start();
+*
+:  BSF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  BSF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+A:  MOVWF  07
+B:  NOP
+C:  BCF    03.5
+D:  BCF    07.4
+E:  BCF    20.4
+F:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  BCF    07.3
+:  BCF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+.................... i2c_write(HMC5883L_WRT_ADDR);
+:  MOVLW  3C
+A:  BCF    03.5
+B:  MOVWF  3D
+C:  CALL   089
+.................... i2c_write(HMC5883L_X_MSB_REG);  // Point to X-msb register
+D:  MOVLW  03
+E:  MOVWF  3D
+F:  CALL   089
+.................... i2c_start();
+:  BSF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  BSF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+A:  NOP
+B:  BCF    03.5
+C:  BTFSS  07.3
+D:  GOTO   17C
+E:  BCF    07.4
+F:  BCF    20.4
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  NOP
+:  BCF    03.5
+:  BCF    07.3
+:  BCF    20.3
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+.................... i2c_write(HMC5883L_READ_ADDR);
+A:  MOVLW  3D
+B:  BCF    03.5
+C:  MOVWF  3D
+D:  CALL   089
+....................
+.................... x_msb = i2c_read();
+E:  MOVLW  01
+F:  MOVWF  77
+:  CALL   10C
+:  MOVF   78,W
+:  MOVWF  38
+.................... x_lsb = i2c_read();
+:  MOVLW  01
+:  MOVWF  77
+:  CALL   10C
+:  MOVF   78,W
+:  MOVWF  37
+....................
+.................... z_msb = i2c_read();
+:  MOVLW  01
+:  MOVWF  77
+A:  CALL   10C
+B:  MOVF   78,W
+C:  MOVWF  3C
+.................... z_lsb = i2c_read();
+D:  MOVLW  01
+E:  MOVWF  77
+F:  CALL   10C
+A0:  MOVF   78,W
+A1:  MOVWF  3B
+....................
+.................... y_msb = i2c_read();
+A2:  MOVLW  01
+A3:  MOVWF  77
+A4:  CALL   10C
+A5:  MOVF   78,W
+A6:  MOVWF  3A
+.................... y_lsb = i2c_read(0); // do a NACK on last read
+A7:  CLRF   77
+A8:  CALL   10C
+A9:  MOVF   78,W
+AA:  MOVWF  39
+....................
+.................... i2c_stop();
+AB:  BCF    20.4
+AC:  MOVF   20,W
+AD:  BSF    03.5
+AE:  MOVWF  07
+AF:  NOP
+B0:  BCF    03.5
+B1:  BSF    20.3
+B2:  MOVF   20,W
+B3:  BSF    03.5
+B4:  MOVWF  07
+B5:  BCF    03.5
+B6:  BTFSS  07.3
+B7:  GOTO   1B6
+B8:  NOP
+B9:  GOTO   1BA
+BA:  NOP
+BB:  BSF    20.4
+BC:  MOVF   20,W
+BD:  BSF    03.5
+BE:  MOVWF  07
+BF:  NOP
+....................
+.................... // Combine high and low bytes into 16-bit values.
+.................... compass.x = make16(x_msb, x_lsb);
+C0:  BCF    03.5
+C1:  MOVF   38,W
+C2:  MOVWF  22
+C3:  MOVF   37,W
+C4:  MOVWF  21
+.................... compass.y = make16(y_msb, y_lsb);
+C5:  MOVF   3A,W
+C6:  MOVWF  24
+C7:  MOVF   39,W
+C8:  MOVWF  23
+.................... compass.z = make16(z_msb, z_lsb);
+C9:  MOVF   3C,W
+CA:  MOVWF  26
+CB:  MOVF   3B,W
+CC:  MOVWF  25
+.................... }
+CD:  BCF    0A.3
+CE:  BCF    0A.4
+CF:  GOTO   2F6 (RETURN)
+....................
+....................
+....................
+....................
+.................... #include <math.h>
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... ////        (C) Copyright 1996,2008 Custom Computer Services            ////
+.................... //// This source code may only be used by licensed users of the CCS C   ////
+.................... //// compiler.  This source code may only be distributed to other       ////
+.................... //// licensed users of the CCS C compiler.  No other use, reproduction  ////
+.................... //// or distribution is permitted without written permission.           ////
+.................... //// Derivative programs created using this software in object code     ////
+.................... //// form are not restricted in any way.                                ////
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... ////                                                                    ////
+.................... //// History:                                                           ////
+.................... ////  * 9/20/2001 :  Improvments are made to sin/cos code.              ////
+.................... ////                 The code now is small, much faster,                ////
+.................... ////                 and more accurate.                                 ////
+.................... ////  * 2/21/2007 :  Compiler handles & operator differently and does
+.................... ////                 not return generic (int8 *) so type cast is done   ////
+.................... ////                                                                    ////
+.................... ////////////////////////////////////////////////////////////////////////////
+....................
+.................... #ifndef MATH_H
+.................... #define MATH_H
+....................
+.................... #ifdef PI
+.................... #undef  PI
+.................... #endif
+.................... #define PI     3.1415926535897932
+....................
+....................
+.................... #define SQRT2  1.4142135623730950
+....................
+.................... //float const ps[4] = {5.9304945, 21.125224, 8.9403076, 0.29730279};
+.................... //float const qs[4] = {1.0000000, 15.035723, 17.764134, 2.4934718};
+....................
+.................... ///////////////////////////// Round Functions //////////////////////////////
+....................
+.................... float32 CEIL_FLOOR(float32 x, unsigned int8 n)
+.................... {
+....................    float32 y, res;
+....................    unsigned int16 l;
+....................    int1 s;
+....................
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y <= 32768.0)
+....................   res = (float32)(unsigned int16)y;
+....................
+....................  else if (y < 10000000.0)
+....................    {
+....................   l = (unsigned int16)(y/32768.0);
+....................       y = 32768.0*(y/32768.0 - (float32)l);
+....................   res = 32768.0*(float32)l;
+....................   res += (float32)(unsigned int16)y;
+....................  }
+....................
+....................  else
+....................   res = y;
+....................
+....................  y = y - (float32)(unsigned int16)y;
+....................
+....................  if (s)
+....................   res = -res;
+....................
+....................  if (y != 0)
+....................  {
+....................   if (s == 1 && n == 0)
+....................    res -= 1.0;
+....................
+....................   if (s == 0 && n == 1)
+....................    res += 1.0;
+....................  }
+....................  if (x == 0)
+....................     res = 0;
+....................
+....................  return (res);
+.................... }
+....................
+.................... // Overloaded Functions to take care for new Data types in PCD
+.................... // Overloaded function CEIL_FLOOR() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 CEIL_FLOOR(float48 x, unsigned int8 n)
+.................... {
+....................    float48 y, res;
+....................    unsigned int16 l;
+....................    int1 s;
+....................
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y <= 32768.0)
+....................   res = (float48)(unsigned int16)y;
+....................
+....................  else if (y < 10000000.0)
+....................    {
+....................   l = (unsigned int16)(y/32768.0);
+....................       y = 32768.0*(y/32768.0 - (float48)l);
+....................   res = 32768.0*(float32)l;
+....................   res += (float48)(unsigned int16)y;
+....................  }
+....................
+....................  else
+....................   res = y;
+....................
+....................  y = y - (float48)(unsigned int16)y;
+....................
+....................  if (s)
+....................   res = -res;
+....................
+....................  if (y != 0)
+....................  {
+....................   if (s == 1 && n == 0)
+....................    res -= 1.0;
+....................
+....................   if (s == 0 && n == 1)
+....................    res += 1.0;
+....................  }
+....................  if (x == 0)
+....................     res = 0;
+....................
+....................  return (res);
+.................... }
+....................
+....................
+.................... // Overloaded function CEIL_FLOOR() for data type - Float64
+.................... float64 CEIL_FLOOR(float64 x, unsigned int8 n)
+.................... {
+....................    float64 y, res;
+....................    unsigned int16 l;
+....................    int1 s;
+....................
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y <= 32768.0)
+....................   res = (float64)(unsigned int16)y;
+....................
+....................  else if (y < 10000000.0)
+....................    {
+....................   l = (unsigned int16)(y/32768.0);
+....................       y = 32768.0*(y/32768.0 - (float64)l);
+....................   res = 32768.0*(float64)l;
+....................   res += (float64)(unsigned int16)y;
+....................  }
+....................
+....................  else
+....................   res = y;
+....................
+....................  y = y - (float64)(unsigned int16)y;
+....................
+....................  if (s)
+....................   res = -res;
+....................
+....................  if (y != 0)
+....................  {
+....................   if (s == 1 && n == 0)
+....................    res -= 1.0;
+....................
+....................   if (s == 0 && n == 1)
+....................    res += 1.0;
+....................  }
+....................  if (x == 0)
+....................     res = 0;
+....................
+....................  return (res);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float floor(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : rounds down the number x.
+.................... // Date : N/A
+.................... //
+.................... float32 floor(float32 x)
+.................... {
+....................    return CEIL_FLOOR(x, 0);
+.................... }
+.................... // Following 2 functions are overloaded functions of floor() for PCD
+.................... // Overloaded function floor() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 floor(float48 x)
+.................... {
+....................    return CEIL_FLOOR(x, 0);
+.................... }
+....................
+.................... // Overloaded function floor() for data type - Float64
+.................... float64 floor(float64 x)
+.................... {
+....................    return CEIL_FLOOR(x, 0);
+.................... }
+.................... #endif
+....................
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float ceil(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : rounds up the number x.
+.................... // Date : N/A
+.................... //
+.................... float32 ceil(float32 x)
+.................... {
+....................    return CEIL_FLOOR(x, 1);
+.................... }
+.................... // Following 2 functions are overloaded functions of ceil() for PCD
+.................... // Overloaded function ceil() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 ceil(float48 x)
+.................... {
+....................    return CEIL_FLOOR(x, 1);
+.................... }
+....................
+.................... // Overloaded function ceil() for data type - Float64
+.................... float64 ceil(float64 x)
+.................... {
+....................    return CEIL_FLOOR(x, 1);
+.................... }
+.................... #endif
+....................
+....................  ////////////////////////////////////////////////////////////////////////////
+.................... //   float fabs(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : Computes the absolute value of floating point number x
+.................... // Returns : returns the absolute value of x
+.................... // Date : N/A
+.................... //
+.................... #define fabs abs
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float fmod(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : Computes the floating point remainder of x/y
+.................... // Returns : returns the value of x= i*y, for some integer i such that, if y
+.................... // is non zero, the result has the same isgn of x na dmagnitude less than the
+.................... // magnitude of y. If y is zero then a domain error occurs.
+.................... // Date : N/A
+.................... //
+....................
+.................... float fmod(float32 x,float32 y)
+.................... {
+....................    float32 i;
+....................    if (y!=0.0)
+....................    {
+....................       i=(x/y < 0.0)? ceil(x/y): floor(x/y);
+....................       return(x-(i*y));
+....................    }
+....................    else
+....................    {
+....................    #ifdef _ERRNO
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    }
+.................... }
+.................... //Overloaded function for fmod() for PCD
+.................... // Overloaded function fmod() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 fmod(float48 x,float48 y)
+.................... {
+....................    float48 i;
+....................    if (y!=0.0)
+....................    {
+....................       i=(x/y < 0.0)? ceil(x/y): floor(x/y);
+....................       return(x-(i*y));
+....................    }
+....................    else
+....................    {
+....................    #ifdef _ERRNO
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    }
+.................... }
+.................... // Overloaded function fmod() for data type - Float64
+.................... float64 fmod(float64 x,float64 y)
+.................... {
+....................    float64 i;
+....................    if (y!=0.0)
+....................    {
+....................       i=(x/y < 0.0)? ceil(x/y): floor(x/y);
+....................       return(x-(i*y));
+....................    }
+....................    else
+....................    {
+....................    #ifdef _ERRNO
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    }
+.................... }
+.................... #endif
+.................... //////////////////// Exponential and logarithmic functions ////////////////////
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float exp(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the value (e^x)
+.................... // Date : N/A
+.................... //
+.................... #define LN2 0.6931471805599453
+....................
+.................... float const pe[6] = {0.000207455774, 0.00127100575, 0.00965065093,
+....................                      0.0554965651,  0.240227138,  0.693147172};
+....................
+....................
+.................... float32 exp(float32 x)
+.................... {
+....................    float32 y, res, r;
+....................    #if defined(__PCD__)
+....................    int8 data1;
+....................    #endif
+....................    signed int8 n;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x > 88.722838)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    n = (signed int16)(x/LN2);
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       n = -n;
+....................       y = -y;
+....................    }
+....................
+....................    res = 0.0;
+.................... #if !defined(__PCD__)
+....................    *((unsigned int8 *)(&res)) = n + 0x7F;
+.................... #endif
+....................
+.................... #if defined(__PCD__)  // Takes care of IEEE format for PCD
+....................    data1 = n+0x7F;
+....................    if(bit_test(data1,0))
+....................    bit_set(*(((unsigned int8 *)(&res)+2)),7);
+....................    rotate_right(&data1,1);
+....................    bit_clear(data1,7);
+....................    *(((unsigned int8 *)(&res)+3)) = data1;
+.................... #endif
+....................
+....................    y = y/LN2 - (float32)n;
+....................
+....................    r = pe[0]*y + pe[1];
+....................    r = r*y + pe[2];
+....................    r = r*y + pe[3];
+....................    r = r*y + pe[4];
+....................    r = r*y + pe[5];
+....................
+....................    res = res*(1.0 + y*r);
+....................
+....................    if (s)
+....................       res = 1.0/res;
+....................    return(res);
+.................... }
+....................
+....................
+.................... //Overloaded function for exp() for PCD
+.................... // Overloaded function exp() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 exp(float48 x)
+.................... {
+....................    float48 y, res, r;
+....................    int8 data1;
+....................    signed int8 n;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x > 88.722838)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    n = (signed int16)(x/LN2);
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       n = -n;
+....................       y = -y;
+....................    }
+....................
+....................    res = 0.0;
+....................
+....................    data1 = n+0x7F;
+....................    if(bit_test(data1,0))
+....................    bit_set(*(((unsigned int8 *)(&res)+4)),7);
+....................    rotate_right(&data1,1);
+....................    bit_clear(data1,7);
+....................    *(((unsigned int8 *)(&res)+5)) = data1;
+....................
+....................    y = y/LN2 - (float48)n;
+....................
+....................    r = pe[0]*y + pe[1];
+....................    r = r*y + pe[2];
+....................    r = r*y + pe[3];
+....................    r = r*y + pe[4];
+....................    r = r*y + pe[5];
+....................
+....................    res = res*(1.0 + y*r);
+....................
+....................    if (s)
+....................       res = 1.0/res;
+....................    return(res);
+.................... }
+....................
+.................... // Overloaded function exp() for data type - Float64
+.................... float64 exp(float64 x)
+.................... {
+....................    float64 y, res, r;
+....................    unsigned int16 data1, data2;
+....................    unsigned int16 *p;
+....................    signed int16 n;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x > 709.7827128)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    n = (signed int16)(x/LN2);
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       n = -n;
+....................       y = -y;
+....................    }
+....................
+....................    res = 0.0;
+....................
+.................... #if !defined(__PCD__)
+....................    *((unsigned int16 *)(&res)) = n + 0x7F;
+.................... #endif
+....................    p= (((unsigned int16 *)(&res))+3);
+....................    data1 = *p;
+....................    data2 = *p;
+....................    data1 = n + 0x3FF;
+....................    data1 = data1 <<4;
+....................    if(bit_test(data2,15))
+....................    bit_set(data1,15);
+....................    data2 = data2 & 0x000F;
+....................    data1 ^= data2;
+....................
+....................    *(((unsigned int16 *)(&res)+3)) = data1;
+....................
+....................
+....................    y = y/LN2 - (float64)n;
+....................
+....................    r = pe[0]*y + pe[1];
+....................    r = r*y + pe[2];
+....................    r = r*y + pe[3];
+....................    r = r*y + pe[4];
+....................    r = r*y + pe[5];
+....................
+....................    res = res*(1.0 + y*r);
+....................
+....................    if (s)
+....................       res = 1.0/res;
+....................    return(res);
+.................... }
+....................
+.................... #ENDIF
+....................
+....................
+.................... /************************************************************/
+....................
+.................... float32 const pl[4] = {0.45145214, -9.0558803, 26.940971, -19.860189};
+.................... float32 const ql[4] = {1.0000000,  -8.1354259, 16.780517, -9.9300943};
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float log(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the the natural log of x
+.................... // Date : N/A
+.................... //
+.................... float32 log(float32 x)
+.................... {
+....................    float32 y, res, r, y2;
+....................    #if defined(__PCD__)
+....................    unsigned int8  data1,data2;
+....................    #endif
+....................    signed int8 n;
+....................    #ifdef _ERRNO
+....................    if(x <0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    if(x ==0)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    y = x;
+....................
+....................    if (y != 1.0)
+....................    {
+.................... #if !defined(__PCD__)
+....................     *((unsigned int8 *)(&y)) = 0x7E;
+.................... #endif
+....................
+.................... #if defined(__PCD__) // Takes care of IEEE format
+....................    data2 = *(((unsigned int8 *)(&y))+3);
+....................    *(((unsigned int8 *)(&y))+3) = 0x3F;
+....................    data1 = *(((unsigned int8 *)(&y))+2);
+....................    bit_clear(data1,7);
+....................    *(((unsigned int8 *)(&y))+2) = data1;
+....................    if(bit_test(data2,7))
+....................    bit_set(*(((unsigned int8 *)(&y))+3),7);
+.................... #endif
+....................
+....................       y = (y - 1.0)/(y + 1.0);
+....................
+....................       y2=y*y;
+....................
+....................       res = pl[0]*y2 + pl[1];
+....................       res = res*y2 + pl[2];
+....................       res = res*y2 + pl[3];
+....................
+....................       r = ql[0]*y2 + ql[1];
+....................       r = r*y2 + ql[2];
+....................       r = r*y2 + ql[3];
+....................
+....................       res = y*res/r;
+.................... #if !defined(__PCD__)
+....................       n = *((unsigned int8 *)(&x)) - 0x7E;
+.................... #endif
+.................... #if defined(__PCD__)
+....................     data1 = *(((unsigned int8 *)(&x)+3));
+....................     rotate_left(&data1,1);
+....................     data2 = *(((unsigned int8 *)(&x)+2));
+....................     if(bit_test (data2,7))
+....................       bit_set(data1,0);
+....................     n = data1 - 0x7E;
+.................... #endif
+....................
+....................       if (n<0)
+....................          r = -(float32)-n;
+....................       else
+....................          r = (float32)n;
+....................
+....................       res += r*LN2;
+....................    }
+....................
+....................    else
+....................       res = 0.0;
+....................
+....................    return(res);
+.................... }
+....................
+.................... //Overloaded function for log() for PCD
+.................... // Overloaded function log() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 log(float48 x)
+.................... {
+....................    float48 y, res, r, y2;
+....................    unsigned int8  data1,data2;
+....................    signed int8 n;
+....................    #ifdef _ERRNO
+....................    if(x <0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    if(x ==0)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    y = x;
+....................
+....................    if (y != 1.0)
+....................    {
+....................
+....................    #if !defined(__PCD__)
+....................        *((unsigned int8 *)(&y)) = 0x7E;
+....................    #endif
+....................       data2 = *(((unsigned int8 *)(&y))+5);
+....................       *(((unsigned int8 *)(&y))+5) = 0x3F;
+....................       data1 = *(((unsigned int8 *)(&y))+4);
+....................       bit_clear(data1,7);
+....................       *(((unsigned int8 *)(&y))+4) = data1;
+....................
+....................       if(bit_test(data2,7))
+....................          bit_set(*(((unsigned int8 *)(&y))+4),7);
+....................       y = (y - 1.0)/(y + 1.0);
+....................
+....................       y2=y*y;
+....................
+....................       res = pl[0]*y2 + pl[1];
+....................       res = res*y2 + pl[2];
+....................       res = res*y2 + pl[3];
+....................
+....................       r = ql[0]*y2 + ql[1];
+....................       r = r*y2 + ql[2];
+....................       r = r*y2 + ql[3];
+....................
+....................       res = y*res/r;
+....................
+....................     data1 = *(((unsigned int8 *)(&x)+5));
+....................     rotate_left(&data1,1);
+....................     data2 = *(((unsigned int8 *)(&x)+4));
+....................     if(bit_test (data2,7))
+....................        bit_set(data1,0);
+....................
+....................     n = data1 - 0x7E;
+....................
+....................       if (n<0)
+....................          r = -(float48)-n;
+....................       else
+....................          r = (float48)n;
+....................
+....................       res += r*LN2;
+....................    }
+....................
+....................    else
+....................       res = 0.0;
+....................
+....................    return(res);
+.................... }
+....................
+.................... // Overloaded function log() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float32 const pl_64[4] = {0.45145214, -9.0558803, 26.940971, -19.860189};
+.................... float32 const ql_64[4] = {1.0000000,  -8.1354259, 16.780517, -9.9300943};
+.................... #endif
+.................... float64 log(float64 x)
+.................... {
+....................    float64 y, res, r, y2;
+....................    unsigned int16  data1,data2;
+....................    unsigned int16 *p;
+....................    signed int16 n;
+....................    #ifdef _ERRNO
+....................    if(x <0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    if(x ==0)
+....................    {
+....................       errno=ERANGE;
+....................       return(0);
+....................    }
+....................    #endif
+....................    y = x;
+....................
+....................    if (y != 1.0)
+....................    {
+....................    #if !defined(__PCD__)
+....................        *((unsigned int8 *)(&y)) = 0x7E;
+....................    #endif
+....................       p= (((unsigned int16 *)(&y))+3);
+....................       data1 = *p;
+....................       data2 = *p;
+....................       data1 = 0x3FE;
+....................       data1 = data1 <<4;
+....................       if(bit_test (data2,15))
+....................       bit_set(data1,15);
+....................       data2 = data2 & 0x000F;
+....................       data1 ^=data2;
+....................
+....................       *p = data1;
+....................
+....................       y = (y - 1.0)/(y + 1.0);
+....................
+....................       y2=y*y;
+....................
+....................       res = pl_64[0]*y2 + pl_64[1];
+....................       res = res*y2 + pl_64[2];
+....................       res = res*y2 + pl_64[3];
+....................
+....................       r = ql_64[0]*y2 + ql_64[1];
+....................       r = r*y2 + ql_64[2];
+....................       r = r*y2 + ql_64[3];
+....................
+....................       res = y*res/r;
+....................
+....................       p= (((unsigned int16 *)(&x))+3);
+....................       data1 = *p;
+....................       bit_clear(data1,15);
+....................       data1 = data1 >>4;
+....................       n = data1 - 0x3FE;
+....................
+....................
+....................       if (n<0)
+....................          r = -(float64)-n;
+....................       else
+....................          r = (float64)n;
+....................
+....................       res += r*LN2;
+....................    }
+....................
+....................    else
+....................       res = 0.0;
+....................
+....................    return(res);
+.................... }
+.................... #endif
+....................
+....................
+.................... #define LN10 2.3025850929940456
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float log10(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the the log base 10 of x
+.................... // Date : N/A
+.................... //
+.................... float32 log10(float32 x)
+.................... {
+....................    float32 r;
+....................
+....................    r = log(x);
+....................    r = r/LN10;
+....................    return(r);
+.................... }
+....................
+.................... //Overloaded functions for log10() for PCD
+.................... // Overloaded function log10() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 log10(float48 x)
+.................... {
+....................    float48 r;
+....................
+....................    r = log(x);
+....................    r = r/LN10;
+....................    return(r);
+.................... }
+....................
+.................... // Overloaded function log10() for data type - Float64
+.................... float64 log10(float64 x)
+.................... {
+....................    float64 r;
+....................
+....................    r = log(x);
+....................    r = r/LN10;
+....................    return(r);
+.................... }
+.................... #endif
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float modf(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description :breaks the argument value int integral and fractional parts,
+.................... // ach of which have the same sign as the argument.  It stores the integral part
+.................... // as a float in the object pointed to by the iptr
+.................... // Returns : returns the signed fractional part of value.
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 modf(float32 value,float32 *iptr)
+.................... {
+....................    *iptr=(value < 0.0)? ceil(value): floor(value);
+....................    return(value - *iptr);
+.................... }
+.................... //Overloaded functions for modf() for PCD
+.................... // Overloaded function modf() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 modf(float48 value,float48 *iptr)
+.................... {
+....................    *iptr=(value < 0.0)? ceil(value): floor(value);
+....................    return(value - *iptr);
+.................... }
+.................... // Overloaded function modf() for data type - Float64
+.................... float64 modf(float64 value,float64 *iptr)
+.................... {
+....................    *iptr=(value < 0.0)? ceil(value): floor(value);
+....................    return(value - *iptr);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float pwr(float x,float y)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the value (x^y)
+.................... // Date : N/A
+.................... // Note : 0 is returned when the function will generate an imaginary number
+.................... //
+.................... float32 pwr(float32 x,float32 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+.................... //Overloaded functions for pwr() for PCD
+.................... // Overloaded function pwr() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 pwr(float48 x,float48 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+.................... // Overloaded function pwr() for data type - Float64
+.................... float64 pwr(float64 x,float64 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+.................... #endif
+....................
+.................... //////////////////// Power functions ////////////////////
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float pow(float x,float y)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the value (x^y)
+.................... // Date : N/A
+.................... // Note : 0 is returned when the function will generate an imaginary number
+.................... //
+.................... float32 pow(float32 x,float32 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+.................... //Overloaded functions for pow() for PCD
+.................... // Overloaded function for pow() data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 pow(float48 x,float48 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+....................
+.................... // Overloaded function pow() for data type - Float64
+.................... float64 pow(float64 x,float64 y)
+.................... {
+....................    if(0 > x && fmod(y, 1) == 0) {
+....................       if(fmod(y, 2) == 0) {
+....................          return (exp(log(-x) * y));
+....................       } else {
+....................          return (-exp(log(-x) * y));
+....................       }
+....................    } else if(0 > x && fmod(y, 1) != 0) {
+....................       return 0;
+....................    } else {
+....................       if(x != 0 || 0 >= y) {
+....................          return (exp(log(x) * y));
+....................       }
+....................    }
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float sqrt(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the square root of x
+.................... // Date : N/A
+.................... //
+.................... float32 sqrt(float32 x)
+.................... {
+....................    float32 y, res;
+....................    #if defined(__PCD__)
+....................    unsigned int16 data1,data2;
+....................    #endif
+....................    BYTE *p;
+....................
+....................    #ifdef _ERRNO
+....................    if(x < 0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................
+....................    if( x<=0.0)
+....................       return(0.0);
+....................
+....................    y=x;
+....................
+....................    #if !defined(__PCD__)
+....................     p=&y;
+....................    (*p)=(BYTE)((((unsigned int16)(*p)) + 127) >> 1);
+....................    #endif
+....................
+....................    #if defined(__PCD__)
+....................     p = (((unsigned int8 *)(&y))+3);
+....................     data1 = *(((unsigned int8 *)(&y))+3);
+....................     data2 = *(((unsigned int8 *)(&y))+2);
+....................     rotate_left(&data1,1);
+....................     if(bit_test(data2,7))
+....................     bit_set(data1,0);
+....................     data1 = ((data1+127) >>1);
+....................     bit_clear(data2,7);
+....................     if(bit_test(data1,0))
+....................     bit_set(data2,7);
+....................     data1 = data1 >>1;
+....................     *(((unsigned int8 *)(&y))+3) = data1;
+....................     *(((unsigned int8 *)(&y))+2) = data2;
+....................
+....................   #endif
+....................
+....................    do {
+....................       res=y;
+....................       y+=(x/y);
+....................
+....................       #if !defined(__PCD__)
+....................      (*p)--;
+....................    #endif
+....................
+....................    #if defined(__PCD__)
+....................     data1 = *(((unsigned int8 *)(&y))+3);
+....................     data2 = *(((unsigned int8 *)(&y))+2);
+....................     rotate_left(&data1,1);
+....................     if(bit_test(data2,7))
+....................     bit_set(data1,0);
+....................     data1--;
+....................     bit_clear(data2,7);
+....................     if(bit_test(data1,0))
+....................     bit_set(data2,7);
+....................     data1 = data1 >>1;
+....................     *(((unsigned int8 *)(&y))+3) = data1;
+....................     *(((unsigned int8 *)(&y))+2) = data2;
+....................
+....................   #endif
+....................    } while(res != y);
+....................
+....................    return(res);
+.................... }
+.................... //Overloaded functions for sqrt() for PCD
+.................... // Overloaded function sqrt() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 sqrt(float48 x)
+.................... {
+....................    float48 y, res;
+....................    unsigned int16 data1,data2;
+....................    BYTE *p;
+....................
+....................    #ifdef _ERRNO
+....................    if(x < 0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................
+....................    if( x<=0.0)
+....................       return(0.0);
+....................
+....................    y=x;
+....................
+....................    #if !defined(__PCD__)
+....................     p=&y;
+....................    (*p)=(BYTE)((((unsigned int16)(*p)) + 127) >> 1);
+....................    #endif
+....................
+....................    #if defined(__PCD__)
+....................     p = (((unsigned int8 *)(&y))+5);
+....................     data1 = *(((unsigned int8 *)(&y))+5);
+....................     data2 = *(((unsigned int8 *)(&y))+4);
+....................     rotate_left(&data1,1);
+....................     if(bit_test(data2,7))
+....................     bit_set(data1,0);
+....................     data1 = ((data1+127) >>1);
+....................     bit_clear(data2,7);
+....................     if(bit_test(data1,0))
+....................     bit_set(data2,7);
+....................     data1 = data1 >>1;
+....................     *(((unsigned int8 *)(&y))+5) = data1;
+....................     *(((unsigned int8 *)(&y))+4) = data2;
+....................
+....................   #endif
+....................
+....................    do {
+....................       res=y;
+....................       y+=(x/y);
+....................
+....................       #if !defined(__PCD__)
+....................      (*p)--;
+....................    #endif
+....................
+....................     data1 = *(((unsigned int8 *)(&y))+5);
+....................     data2 = *(((unsigned int8 *)(&y))+4);
+....................     rotate_left(&data1,1);
+....................     if(bit_test(data2,7))
+....................     bit_set(data1,0);
+....................     data1--;
+....................     bit_clear(data2,7);
+....................     if(bit_test(data1,0))
+....................     bit_set(data2,7);
+....................     data1 = data1 >>1;
+....................     *(((unsigned int8 *)(&y))+5) = data1;
+....................     *(((unsigned int8 *)(&y))+4) = data2;
+....................
+....................    } while(res != y);
+....................
+....................    return(res);
+.................... }
+....................
+.................... // Overloaded function sqrt() for data type - Float64
+.................... float64 sqrt(float64 x)
+.................... {
+....................    float64 y, res;
+....................    unsigned int16 *p;
+....................    unsigned int16 temp1,temp2;
+....................
+....................    #ifdef _ERRNO
+....................    if(x < 0)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................
+....................    if( x<=0.0)
+....................       return(0.0);
+....................
+....................    y=x;
+....................    p= (((unsigned int16 *)(&y))+3);
+....................    temp1 = *p;
+....................    temp2 = *p;
+....................    bit_clear(temp1,15);
+....................    temp1 = (temp1>>4)+1023;
+....................    temp1 = temp1 >> 1;
+....................    temp1 = (temp1<<4) & 0xFFF0;
+....................    if(bit_test(temp2,15))
+....................    bit_set(temp1,15);
+....................    temp2 = temp2 & 0x000F;
+....................    temp1 ^= temp2;
+....................
+....................    (*p) = temp1;
+....................
+....................    do {
+....................       res=y;
+....................       y+=(x/y);
+....................      temp1 = *p;
+....................      temp2 = *p;
+....................      bit_clear(temp1,15);
+....................      temp1 = (temp1>>4);
+....................      temp1--;
+....................      temp1 = (temp1<<4) & 0xFFF0;
+....................      if(bit_test(temp2,15))
+....................      bit_set(temp1,15);
+....................      temp2 = temp2 & 0x000F;
+....................      temp1 ^= temp2;
+....................      (*p) = temp1;
+....................
+....................    } while(res != y);
+....................
+....................    return(res);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////// Trig Functions //////////////////////////////
+.................... #ifdef PI_DIV_BY_TWO
+.................... #undef PI_DIV_BY_TWO
+.................... #endif
+.................... #define PI_DIV_BY_TWO   1.5707963267948966
+.................... #ifdef TWOBYPI
+.................... #undef TWOBYPI
+.................... #define TWOBYPI          0.6366197723675813
+.................... #endif
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float cos(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the cosine value of the angle x, which is in radian
+.................... // Date : 9/20/2001
+.................... //
+.................... float32 cos(float32 x)
+.................... {
+....................    float32 y, t, t2 = 1.0;
+....................    unsigned int8 quad, i;
+....................    float32 frac;
+....................    float32 p[6] = {                    //by the series definition for cosine
+....................       -0.5,                            // sum ( ( (-1)^n * x^2n )/(2n)! )
+....................        0.04166666666667,
+....................       -0.00138888888889,
+....................        0.00002480158730,
+....................       -0.00000027557319,
+....................        0.00000000208767,
+....................       //-0.00000000001147,
+....................       // 0.00000000000005
+....................    };
+....................
+....................    if (x < 0) x = -x;                  // absolute value of input
+....................
+....................    quad = (unsigned int8)(x / PI_DIV_BY_TWO);    // quadrant
+....................    frac = (x / PI_DIV_BY_TWO) - quad;  // fractional part of input
+....................    quad = quad % 4;                    // quadrant (0 to 3)
+....................
+....................    if (quad == 0 || quad == 2)
+....................       t = frac * PI_DIV_BY_TWO;
+....................    else if (quad == 1)
+....................       t = (1-frac) * PI_DIV_BY_TWO;
+....................    else // should be 3
+....................       t = (frac-1) * PI_DIV_BY_TWO;
+....................
+....................    y = 1.0;
+....................    t = t * t;
+....................    for (i = 0; i <= 5; i++)
+....................    {
+....................       t2 = t2 * t;
+....................       y = y + p[i] * t2;
+....................    }
+....................
+....................    if (quad == 2 || quad == 1)
+....................       y = -y;  // correct sign
+....................
+....................    return (y);
+.................... }
+....................
+....................
+.................... //Overloaded functions for cos() for PCD
+.................... // Overloaded function cos() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 cos(float48 x)
+.................... {
+....................    float48 y, t, t2 = 1.0;
+....................    unsigned int8 quad, i;
+....................    float48 frac;
+....................    float48 p[6] = {                    //by the series definition for cosine
+....................       -0.5,                            // sum ( ( (-1)^n * x^2n )/(2n)! )
+....................        0.04166666666667,
+....................       -0.00138888888889,
+....................        0.00002480158730,
+....................       -0.00000027557319,
+....................        0.00000000208767,
+....................       //-0.00000000001147,
+....................       // 0.00000000000005
+....................    };
+....................
+....................    if (x < 0) x = -x;                  // absolute value of input
+....................
+....................    quad = (unsigned int8)(x / PI_DIV_BY_TWO);    // quadrant
+....................    frac = (x / PI_DIV_BY_TWO) - quad;  // fractional part of input
+....................    quad = quad % 4;                    // quadrant (0 to 3)
+....................
+....................    if (quad == 0 || quad == 2)
+....................       t = frac * PI_DIV_BY_TWO;
+....................    else if (quad == 1)
+....................       t = (1-frac) * PI_DIV_BY_TWO;
+....................    else // should be 3
+....................       t = (frac-1) * PI_DIV_BY_TWO;
+....................
+....................    y = 0.999999999781;
+....................    t = t * t;
+....................    for (i = 0; i <= 5; i++)
+....................    {
+....................       t2 = t2 * t;
+....................       y = y + p[i] * t2;
+....................    }
+....................
+....................    if (quad == 2 || quad == 1)
+....................       y = -y;  // correct sign
+....................
+....................    return (y);
+.................... }
+....................
+.................... // Overloaded function cos() for data type - Float48
+.................... float64 cos(float64 x)
+.................... {
+....................    float64 y, t, t2 = 1.0;
+....................    unsigned int8 quad, i;
+....................    float64 frac;
+....................    float64 p[6] = {                    //by the series definition for cosine
+....................       -0.5,                            // sum ( ( (-1)^n * x^2n )/(2n)! )
+....................        0.04166666666667,
+....................       -0.00138888888889,
+....................        0.00002480158730,
+....................       -0.00000027557319,
+....................        0.00000000208767,
+....................       //-0.00000000001147,
+....................       // 0.00000000000005
+....................    };
+....................
+....................    if (x < 0) x = -x;                  // absolute value of input
+....................
+....................    quad = (unsigned int8)(x / PI_DIV_BY_TWO);    // quadrant
+....................    frac = (x / PI_DIV_BY_TWO) - quad;  // fractional part of input
+....................    quad = quad % 4;                    // quadrant (0 to 3)
+....................
+....................    if (quad == 0 || quad == 2)
+....................       t = frac * PI_DIV_BY_TWO;
+....................    else if (quad == 1)
+....................       t = (1-frac) * PI_DIV_BY_TWO;
+....................    else // should be 3
+....................       t = (frac-1) * PI_DIV_BY_TWO;
+....................
+....................    y = 0.999999999781;
+....................    t = t * t;
+....................    for (i = 0; i <= 5; i++)
+....................    {
+....................       t2 = t2 * t;
+....................       y = y + p[i] * t2;
+....................    }
+....................
+....................    if (quad == 2 || quad == 1)
+....................       y = -y;  // correct sign
+....................
+....................    return (y);
+.................... }
+....................
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float sin(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the sine value of the angle x, which is in radian
+.................... // Date : 9/20/2001
+.................... //
+.................... float32 sin(float32 x)
+.................... {
+....................    return cos(x - PI_DIV_BY_TWO);
+.................... }
+....................
+.................... //Overloaded functions for sin() for PCD
+.................... // Overloaded function sin() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 sin(float48 x)
+.................... {
+....................    return cos(x - PI_DIV_BY_TWO);
+.................... }
+....................
+.................... // Overloaded function sin() for data type - Float48
+.................... float64 sin(float64 x)
+.................... {
+....................    return cos(x - PI_DIV_BY_TWO);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float tan(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the tangent value of the angle x, which is in radian
+.................... // Date : 9/20/2001
+.................... //
+.................... float32 tan(float32 x)
+.................... {
+....................    float32 c, s;
+....................
+....................    c = cos(x);
+....................    if (c == 0.0)
+....................       return (1.0e+36);
+....................
+....................    s = sin(x);
+....................    return(s/c);
+.................... }
+.................... //Overloaded functions for tan() for PCD
+.................... // Overloaded function tan() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 tan(float48 x)
+.................... {
+....................    float48 c, s;
+....................
+....................    c = cos(x);
+....................    if (c == 0.0)
+....................       return (1.0e+36);
+....................
+....................    s = sin(x);
+....................    return(s/c);
+.................... }
+....................
+.................... // Overloaded function tan() for data type - Float48
+.................... float64 tan(float64 x)
+.................... {
+....................    float64 c, s;
+....................
+....................    c = cos(x);
+....................    if (c == 0.0)
+....................       return (1.0e+36);
+....................
+....................    s = sin(x);
+....................    return(s/c);
+.................... }
+.................... #endif
+....................
+.................... float32 const pas[3] = {0.49559947, -4.6145309, 5.6036290};
+.................... float32 const qas[3] = {1.0000000,  -5.5484666, 5.6036290};
+....................
+.................... float32 ASIN_COS(float32 x, unsigned int8 n)
+.................... {
+....................    float32 y, res, r, y2;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x <-1 || x > 1)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 0.5)
+....................    {
+....................       y = sqrt((1.0 - y)/2.0);
+....................       n += 2;
+....................    }
+....................
+....................    y2=y*y;
+....................
+....................    res = pas[0]*y2 + pas[1];
+....................    res = res*y2 + pas[2];
+....................
+....................    r = qas[0]*y2 + qas[1];
+....................    r = r*y2 + qas[2];
+....................
+....................    res = y*res/r;
+....................
+....................    if (n & 2)     // |x| > 0.5
+....................       res = PI_DIV_BY_TWO - 2.0*res;
+....................    if (s)
+....................       res = -res;
+....................    if (n & 1)           // take arccos
+....................       res = PI_DIV_BY_TWO - res;
+....................
+....................    return(res);
+.................... }
+....................
+.................... //Overloaded functions for ASIN_COS() for PCD
+.................... // Overloaded function ASIN_COS() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 ASIN_COS(float48 x, unsigned int8 n)
+.................... {
+....................    float48 y, res, r, y2;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x <-1 || x > 1)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 0.5)
+....................    {
+....................       y = sqrt((1.0 - y)/2.0);
+....................       n += 2;
+....................    }
+....................
+....................    y2=y*y;
+....................
+....................    res = pas[0]*y2 + pas[1];
+....................    res = res*y2 + pas[2];
+....................
+....................    r = qas[0]*y2 + qas[1];
+....................    r = r*y2 + qas[2];
+....................
+....................    res = y*res/r;
+....................
+....................    if (n & 2)     // |x| > 0.5
+....................       res = PI_DIV_BY_TWO - 2.0*res;
+....................    if (s)
+....................       res = -res;
+....................    if (n & 1)           // take arccos
+....................       res = PI_DIV_BY_TWO - res;
+....................
+....................    return(res);
+.................... }
+....................
+.................... // Overloaded function ASIN_COS() for data type - Float64
+.................... float64 ASIN_COS(float64 x, unsigned int8 n)
+.................... {
+....................    float64 y, res, r, y2;
+....................    int1 s;
+....................    #ifdef _ERRNO
+....................    if(x <-1 || x > 1)
+....................    {
+....................       errno=EDOM;
+....................    }
+....................    #endif
+....................    s = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 0.5)
+....................    {
+....................       y = sqrt((1.0 - y)/2.0);
+....................       n += 2;
+....................    }
+....................
+....................    y2=y*y;
+....................
+....................    res = pas[0]*y2 + pas[1];
+....................    res = res*y2 + pas[2];
+....................
+....................    r = qas[0]*y2 + qas[1];
+....................    r = r*y2 + qas[2];
+....................
+....................    res = y*res/r;
+....................
+....................    if (n & 2)     // |x| > 0.5
+....................       res = PI_DIV_BY_TWO - 2.0*res;
+....................    if (s)
+....................       res = -res;
+....................    if (n & 1)           // take arccos
+....................       res = PI_DIV_BY_TWO - res;
+....................
+....................    return(res);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float asin(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the arcsine value of the value x.
+.................... // Date : N/A
+.................... //
+.................... float32 asin(float32 x)
+.................... {
+....................    float32 r;
+....................
+....................    r = ASIN_COS(x, 0);
+....................    return(r);
+.................... }
+.................... //Overloaded functions for asin() for PCD
+.................... // Overloaded function asin() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 asin(float48 x)
+.................... {
+....................    float48 r;
+....................
+....................    r = ASIN_COS(x, 0);
+....................    return(r);
+.................... }
+....................
+.................... // Overloaded function asin() for data type - Float64
+.................... float64 asin(float64 x)
+.................... {
+....................    float64 r;
+....................
+....................    r = ASIN_COS(x, 0);
+....................    return(r);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float acos(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the arccosine value of the value x.
+.................... // Date : N/A
+.................... //
+.................... float32 acos(float32 x)
+.................... {
+....................    float32 r;
+....................
+....................    r = ASIN_COS(x, 1);
+....................    return(r);
+.................... }
+.................... //Overloaded functions for acos() for PCD
+.................... // Overloaded function acos() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 acos(float48 x)
+.................... {
+....................    float48 r;
+....................
+....................    r = ASIN_COS(x, 1);
+....................    return(r);
+.................... }
+....................
+.................... // Overloaded function acos() for data type - Float64
+.................... float64 acos(float64 x)
+.................... {
+....................    float64 r;
+....................
+....................    r = ASIN_COS(x, 1);
+....................    return(r);
+.................... }
+.................... #endif
+....................
+.................... float32 const pat[4] = {0.17630401, 5.6710795, 22.376096, 19.818457};
+.................... float32 const qat[4] = {1.0000000,  11.368190, 28.982246, 19.818457};
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float atan(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : returns the arctangent value of the value x.
+.................... // Date : N/A
+.................... //
+.................... float32 atan(float32 x)
+.................... {
+....................    float32 y, res, r;
+....................    int1 s, flag;
+....................
+....................    s = 0;
+....................    flag = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 1.0)
+....................    {
+....................       y = 1.0/y;
+....................       flag = 1;
+....................    }
+....................
+....................    res = pat[0]*y*y + pat[1];
+....................    res = res*y*y + pat[2];
+....................    res = res*y*y + pat[3];
+....................
+....................    r = qat[0]*y*y + qat[1];
+....................    r = r*y*y + qat[2];
+....................    r = r*y*y + qat[3];
+....................
+....................    res = y*res/r;
+....................
+....................
+....................    if (flag)                              // for |x| > 1
+....................       res = PI_DIV_BY_TWO - res;
+....................    if (s)
+....................       res = -res;
+....................
+....................    return(res);
+.................... }
+.................... //Overloaded functions for atan() for PCD
+.................... // Overloaded function atan() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 atan(float48 x)
+.................... {
+....................    float48 y, res, r;
+....................    int1 s, flag;
+....................
+....................    s = 0;
+....................    flag = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 1.0)
+....................    {
+....................       y = 1.0/y;
+....................       flag = 1;
+....................    }
+....................
+....................    res = pat[0]*y*y + pat[1];
+....................    res = res*y*y + pat[2];
+....................    res = res*y*y + pat[3];
+....................
+....................    r = qat[0]*y*y + qat[1];
+....................    r = r*y*y + qat[2];
+....................    r = r*y*y + qat[3];
+....................
+....................    res = y*res/r;
+....................
+....................
+....................    if (flag)                              // for |x| > 1
+....................       res = PI_DIV_BY_TWO - res;
+....................    if (s)
+....................       res = -res;
+....................
+....................    return(res);
+.................... }
+....................
+.................... // Overloaded function atan() for data type - Float64
+.................... float64 atan(float64 x)
+.................... {
+....................    float64 y, res, r;
+....................    int1 s, flag;
+....................
+....................    s = 0;
+....................    flag = 0;
+....................    y = x;
+....................
+....................    if (x < 0)
+....................    {
+....................       s = 1;
+....................       y = -y;
+....................    }
+....................
+....................    if (y > 1.0)
+....................    {
+....................       y = 1.0/y;
+....................       flag = 1;
+....................    }
+....................
+....................    res = pat[0]*y*y + pat[1];
+....................    res = res*y*y + pat[2];
+....................    res = res*y*y + pat[3];
+....................
+....................    r = qat[0]*y*y + qat[1];
+....................    r = r*y*y + qat[2];
+....................    r = r*y*y + qat[3];
+....................
+....................    res = y*res/r;
+....................
+....................
+....................    if (flag)                              // for |x| > 1
+....................       res = PI_DIV_BY_TWO - res;
+....................    if (s)
+....................       res = -res;
+....................
+....................    return(res);
+.................... }
+.................... #endif
+....................
+.................... /////////////////////////////////////////////////////////////////////////////
+.................... //   float atan2(float y, float x)
+.................... /////////////////////////////////////////////////////////////////////////////
+.................... // Description :computes the principal value of arc tangent of y/x, using the
+.................... // signs of both the arguments to determine the quadrant of the return value
+.................... // Returns : returns the arc tangent of y/x.
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 atan2(float32 y,float32 x)
+.................... {
+....................    float32 z;
+....................    int1 sign;
+....................    unsigned int8 quad;
+....................    sign=0;
+....................    quad=0; //quadrant
+....................    quad=((y<=0.0)?((x<=0.0)?3:4):((x<0.0)?2:1));
+....................    if(y<0.0)
+....................    {
+....................       sign=1;
+....................       y=-y;
+....................    }
+....................    if(x<0.0)
+....................    {
+....................       x=-x;
+....................    }
+....................    if (x==0.0)
+....................    {
+....................       if(y==0.0)
+....................       {
+....................       #ifdef _ERRNO
+....................       {
+....................          errno=EDOM;
+....................       }
+....................       #endif
+....................       }
+....................       else
+....................       {
+....................          if(sign)
+....................          {
+....................          return (-(PI_DIV_BY_TWO));
+....................          }
+....................          else
+....................          {
+....................          return (PI_DIV_BY_TWO);
+....................          }
+....................       }
+....................    }
+....................    else
+....................    {
+....................       z=y/x;
+....................       switch(quad)
+....................       {
+....................          case 1:
+....................          {
+....................             return atan(z);
+....................             break;
+....................          }
+....................          case 2:
+....................          {
+.................... //            return (atan(z)+PI_DIV_BY_TWO);  //2L3122
+....................             return (PI-atan(z));
+....................             break;
+....................          }
+....................          case 3:
+....................          {
+....................             return (atan(z)-PI);
+....................             break;
+....................          }
+....................          case 4:
+....................          {
+....................             return (-atan(z));
+....................             break;
+....................          }
+....................       }
+....................    }
+.................... }
+....................
+.................... //Overloaded functions for atan2() for PCD
+.................... // Overloaded function atan2() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 atan2(float48 y,float48 x)
+.................... {
+....................    float48 z;
+....................    int1 sign;
+....................    unsigned int8 quad;
+....................    sign=0;
+....................    quad=0; //quadrant
+....................    quad=((y<=0.0)?((x<=0.0)?3:4):((x<0.0)?2:1));
+....................    if(y<0.0)
+....................    {
+....................       sign=1;
+....................       y=-y;
+....................    }
+....................    if(x<0.0)
+....................    {
+....................       x=-x;
+....................    }
+....................    if (x==0.0)
+....................    {
+....................       if(y==0.0)
+....................       {
+....................       #ifdef _ERRNO
+....................       {
+....................          errno=EDOM;
+....................       }
+....................       #endif
+....................       }
+....................       else
+....................       {
+....................          if(sign)
+....................          {
+....................          return (-(PI_DIV_BY_TWO));
+....................          }
+....................          else
+....................          {
+....................          return (PI_DIV_BY_TWO);
+....................          }
+....................       }
+....................    }
+....................    else
+....................    {
+....................       z=y/x;
+....................       switch(quad)
+....................       {
+....................          case 1:
+....................          {
+....................             return atan(z);
+....................             break;
+....................          }
+....................          case 2:
+....................          {
+.................... //            return (atan(z)+PI_DIV_BY_TWO);  //2L3122
+....................             return (PI-atan(z));
+....................             break;
+....................          }
+....................          case 3:
+....................          {
+....................             return (atan(z)-PI);
+....................             break;
+....................          }
+....................          case 4:
+....................          {
+....................             return (-atan(z));
+....................             break;
+....................          }
+....................       }
+....................    }
+.................... }
+....................
+.................... // Overloaded function atan2() for data type - Float64
+.................... float64 atan2(float64 y,float64 x)
+.................... {
+....................    float64 z;
+....................    int1 sign;
+....................    unsigned int8 quad;
+....................    sign=0;
+....................    quad=0; //quadrant
+....................    quad=((y<=0.0)?((x<=0.0)?3:4):((x<0.0)?2:1));
+....................    if(y<0.0)
+....................    {
+....................       sign=1;
+....................       y=-y;
+....................    }
+....................    if(x<0.0)
+....................    {
+....................       x=-x;
+....................    }
+....................    if (x==0.0)
+....................    {
+....................       if(y==0.0)
+....................       {
+....................       #ifdef _ERRNO
+....................       {
+....................          errno=EDOM;
+....................       }
+....................       #endif
+....................       }
+....................       else
+....................       {
+....................          if(sign)
+....................          {
+....................          return (-(PI_DIV_BY_TWO));
+....................          }
+....................          else
+....................          {
+....................          return (PI_DIV_BY_TWO);
+....................          }
+....................       }
+....................    }
+....................    else
+....................    {
+....................       z=y/x;
+....................       switch(quad)
+....................       {
+....................          case 1:
+....................          {
+....................             return atan(z);
+....................             break;
+....................          }
+....................          case 2:
+....................          {
+.................... //            return (atan(z)+PI_DIV_BY_TWO);  //2L3122
+....................             return (PI-atan(z));
+....................             break;
+....................          }
+....................          case 3:
+....................          {
+....................             return (atan(z)-PI);
+....................             break;
+....................          }
+....................          case 4:
+....................          {
+....................             return (-atan(z));
+....................             break;
+....................          }
+....................       }
+....................    }
+.................... }
+.................... #endif
+....................
+.................... //////////////////// Hyperbolic functions ////////////////////
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float cosh(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : Computes the hyperbolic cosine value of x
+.................... // Returns : returns the hyperbolic cosine value of x
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 cosh(float32 x)
+.................... {
+....................    return ((exp(x)+exp(-x))/2);
+.................... }
+.................... //Overloaded functions for cosh() for PCD
+.................... // Overloaded function cosh() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 cosh(float48 x)
+.................... {
+....................    return ((exp(x)+exp(-x))/2);
+.................... }
+....................
+.................... // Overloaded function cosh() for data type - Float64
+.................... float64 cosh(float64 x)
+.................... {
+....................    return ((exp(x)+exp(-x))/2);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float sinh(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : Computes the hyperbolic sine value of x
+.................... // Returns : returns the hyperbolic sine value of x
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 sinh(float32 x)
+.................... {
+....................
+....................    return ((exp(x) - exp(-x))/2);
+.................... }
+.................... //Overloaded functions for sinh() for PCD
+.................... // Overloaded function sinh() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 sinh(float48 x)
+.................... {
+....................
+....................    return ((exp(x) - exp(-x))/2);
+.................... }
+....................
+.................... // Overloaded function sinh() for data type - Float48
+.................... float64 sinh(float64 x)
+.................... {
+....................
+....................    return ((exp(x) - exp(-x))/2);
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float tanh(float x)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : Computes the hyperbolic tangent value of x
+.................... // Returns : returns the hyperbolic tangent value of x
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 tanh(float32 x)
+.................... {
+....................    return(sinh(x)/cosh(x));
+.................... }
+.................... //Overloaded functions for tanh() for PCD
+.................... // Overloaded function tanh() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 tanh(float48 x)
+.................... {
+....................    return(sinh(x)/cosh(x));
+.................... }
+....................
+.................... // Overloaded function tanh() for data type - Float64
+.................... float64 tanh(float64 x)
+.................... {
+....................    return(sinh(x)/cosh(x));
+.................... }
+.................... #endif
+....................
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... //   float frexp(float x, signed int *exp)
+.................... ////////////////////////////////////////////////////////////////////////////
+.................... // Description : breaks a floating point number into a normalized fraction and an integral
+.................... // power of 2. It stores the integer in the signed int object pointed to by exp.
+.................... // Returns : returns the value x, such that x is a double with magnitude in the interval
+.................... // [1/2,1) or zero, and value equals x times 2 raised to the power *exp.If value is zero,
+.................... // both parts of the result are zero.
+.................... // Date : N/A
+.................... //
+....................
+.................... #define LOG2 .30102999566398119521
+.................... float32 frexp(float32 x, signed int8 *exp)
+.................... {
+....................    float32 res;
+....................    int1 sign = 0;
+....................    if(x == 0.0)
+....................    {
+....................       *exp=0;
+....................       return (0.0);
+....................    }
+....................    if(x < 0.0)
+....................    {
+....................      x=-x;
+....................      sign=1;
+....................    }
+....................    if (x > 1.0)
+....................    {
+....................       *exp=(ceil(log10(x)/LOG2));
+....................       res=x/(pow(2, *exp));
+....................       if (res == 1)
+....................       {
+....................          *exp=*exp+1;
+....................           res=.5;
+....................       }
+....................    }
+....................    else
+....................    {
+....................       if(x < 0.5)
+....................       {
+....................          *exp=-1;
+....................          res=x*2;
+....................       }
+....................       else
+....................       {
+....................          *exp=0;
+....................           res=x;
+....................       }
+....................    }
+....................    if(sign)
+....................    {
+....................       res=-res;
+....................    }
+....................    return res;
+.................... }
+....................
+.................... //Overloaded functions for frexp() for PCD
+.................... // Overloaded function frexp() for data type - Float48
+.................... #if defined(__PCD__)
+.................... float48 frexp(float48 x, signed int8 *exp)
+.................... {
+....................    float48 res;
+....................    int1 sign = 0;
+....................    if(x == 0.0)
+....................    {
+....................       *exp=0;
+....................       return (0.0);
+....................    }
+....................    if(x < 0.0)
+....................    {
+....................      x=-x;
+....................      sign=1;
+....................    }
+....................    if (x > 1.0)
+....................    {
+....................       *exp=(ceil(log10(x)/LOG2));
+....................       res=x/(pow(2, *exp));
+....................       if (res == 1)
+....................       {
+....................          *exp=*exp+1;
+....................           res=.5;
+....................       }
+....................    }
+....................    else
+....................    {
+....................       if(x < 0.5)
+....................       {
+....................          *exp=-1;
+....................          res=x*2;
+....................       }
+....................       else
+....................       {
+....................          *exp=0;
+....................           res=x;
+....................       }
+....................    }
+....................    if(sign)
+....................    {
+....................       res=-res;
+....................    }
+....................    return res;
+.................... }
+....................
+.................... // Overloaded function frexp() for data type - Float64
+.................... float64 frexp(float64 x, signed int8 *exp)
+.................... {
+....................    float64 res;
+....................    int1 sign = 0;
+....................    if(x == 0.0)
+....................    {
+....................       *exp=0;
+....................       return (0.0);
+....................    }
+....................    if(x < 0.0)
+....................    {
+....................      x=-x;
+....................      sign=1;
+....................    }
+....................    if (x > 1.0)
+....................    {
+....................       *exp=(ceil(log10(x)/LOG2));
+....................       res=x/(pow(2, *exp));
+....................       if (res == 1)
+....................       {
+....................          *exp=*exp+1;
+....................           res=.5;
+....................       }
+....................    }
+....................    else
+....................    {
+....................       if(x < 0.5)
+....................       {
+....................          *exp=-1;
+....................          res=x*2;
+....................       }
+....................       else
+....................       {
+....................          *exp=0;
+....................           res=x;
+....................       }
+....................    }
+....................    if(sign)
+....................    {
+....................       res=-res;
+....................    }
+....................    return res;
+.................... }
+.................... #endif
+....................
+.................... //////////////////////////////////////////////////////////////////////////////
+.................... //   float ldexp(float x, signed int *exp)
+.................... //////////////////////////////////////////////////////////////////////////////
+.................... // Description : multiplies a floating point number by an integral power of 2.
+.................... // Returns : returns the value of x times 2 raised to the power exp.
+.................... // Date : N/A
+.................... //
+....................
+.................... float32 ldexp(float32 value, signed int8 exp)
+.................... {
+....................    return (value * pow(2,exp));
+.................... }
+.................... //Overloaded functions for ldexp() for PCD
+.................... // Overloaded function ldexp() for data type - Float48
+....................
+.................... #if defined(__PCD__)
+.................... float48 ldexp(float48 value, signed int8 exp)
+.................... {
+....................    return (value * pow(2,exp));
+.................... }
+.................... // Overloaded function ldexp() for data type - Float64
+.................... float64 ldexp(float64 value, signed int8 exp)
+.................... {
+....................    return (value * pow(2,exp));
+.................... }
+.................... #endif
+....................
+.................... #endif
+....................
+....................
+.................... void main()
+.................... {
+*
+:  CLRF   04
+:  BCF    03.7
+:  MOVLW  1F
+:  ANDWF  03,F
+A:  MOVLW  71
+B:  BSF    03.5
+C:  MOVWF  0F
+D:  MOVF   0F,W
+E:  BCF    03.5
+F:  BCF    20.7
+:  MOVF   20,W
+:  BSF    03.5
+:  MOVWF  07
+:  BCF    03.5
+:  BSF    07.7
+:  BSF    03.5
+:  BSF    03.6
+:  MOVF   09,W
+:  ANDLW  C0
+:  MOVWF  09
+A:  BCF    03.6
+B:  BCF    1F.4
+C:  BCF    1F.5
+D:  MOVLW  00
+E:  BSF    03.6
+F:  MOVWF  08
+:  BCF    03.5
+:  CLRF   07
+:  CLRF   08
+:  CLRF   09
+*
+D:  CLRF   34
+E:  CLRF   33
+.................... float last,b,anemo_speed;
+.................... unsigned int16 anemo_round=0;
+.................... unsigned int16 i;
+....................
+.................... //signed int16 X,Y,Z;
+....................   setup_adc_ports(NO_ANALOGS|VSS_VDD);
+F:  BSF    03.5
+:  BSF    03.6
+:  MOVF   09,W
+:  ANDLW  C0
+:  MOVWF  09
+:  BCF    03.6
+:  BCF    1F.4
+:  BCF    1F.5
+:  MOVLW  00
+:  BSF    03.6
+:  MOVWF  08
+....................   setup_adc(ADC_CLOCK_DIV_2);
+A:  BCF    03.5
+B:  BCF    03.6
+C:  BCF    1F.6
+D:  BCF    1F.7
+E:  BSF    03.5
+F:  BCF    1F.7
+A0:  BCF    03.5
+A1:  BSF    1F.0
+....................   setup_spi(SPI_SS_DISABLED);
+A2:  BCF    14.5
+A3:  BCF    20.5
+A4:  MOVF   20,W
+A5:  BSF    03.5
+A6:  MOVWF  07
+A7:  BCF    03.5
+A8:  BSF    20.4
+A9:  MOVF   20,W
+AA:  BSF    03.5
+AB:  MOVWF  07
+AC:  BCF    03.5
+AD:  BCF    20.3
+AE:  MOVF   20,W
+AF:  BSF    03.5
+B0:  MOVWF  07
+B1:  MOVLW  01
+B2:  BCF    03.5
+B3:  MOVWF  14
+B4:  MOVLW  00
+B5:  BSF    03.5
+B6:  MOVWF  14
+....................   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
+B7:  MOVF   01,W
+B8:  ANDLW  C7
+B9:  IORLW  08
+BA:  MOVWF  01
+....................   setup_timer_1(T1_DISABLED);
+BB:  BCF    03.5
+BC:  CLRF   10
+....................   setup_timer_2(T2_DISABLED,0,1);
+BD:  MOVLW  00
+BE:  MOVWF  78
+BF:  MOVWF  12
+C0:  MOVLW  00
+C1:  BSF    03.5
+C2:  MOVWF  12
+....................   setup_ccp1(CCP_OFF);
+C3:  BCF    03.5
+C4:  BSF    20.2
+C5:  MOVF   20,W
+C6:  BSF    03.5
+C7:  MOVWF  07
+C8:  BCF    03.5
+C9:  CLRF   17
+CA:  BSF    03.5
+CB:  CLRF   1B
+CC:  CLRF   1C
+CD:  MOVLW  01
+CE:  MOVWF  1D
+....................   setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard
+CF:  BCF    03.5
+D0:  BSF    03.6
+D1:  CLRF   07
+D2:  CLRF   08
+D3:  CLRF   09
+....................
+....................   printf("Magnetometr:  \r\n",);
+D4:  MOVLW  04
+D5:  MOVWF  0D
+D6:  MOVLW  00
+D7:  MOVWF  0F
+D8:  BCF    03.6
+D9:  CALL   043
+....................   printf("(c)mlab JACHO 2013:  \r\n",);
+DA:  MOVLW  0D
+DB:  BSF    03.6
+DC:  MOVWF  0D
+DD:  MOVLW  00
+DE:  MOVWF  0F
+DF:  BCF    03.6
+E0:  CALL   043
+....................   printf("X, Y, Z \r\n",);
+E1:  MOVLW  19
+E2:  BSF    03.6
+E3:  MOVWF  0D
+E4:  MOVLW  00
+E5:  MOVWF  0F
+E6:  BCF    03.6
+E7:  CALL   043
+....................
+....................
+.................... // Init the HMC5883L.  Set Mode register for
+.................... // continuous measurements.
+.................... hmc5883l_write_reg(HMC5883L_CFG_A_REG, 0x18);      // no average, maximal update range
+E8:  CLRF   37
+E9:  MOVLW  18
+EA:  MOVWF  38
+EB:  CALL   0D3
+.................... hmc5883l_write_reg(HMC5883L_CFG_B_REG, 0xE0);      // maximal range
+EC:  MOVLW  01
+ED:  MOVWF  37
+EE:  MOVLW  E0
+EF:  MOVWF  38
+F0:  CALL   0D3
+.................... hmc5883l_write_reg(HMC5883L_MODE_REG, 0x00);
+F1:  MOVLW  02
+F2:  MOVWF  37
+F3:  CLRF   38
+F4:  CALL   0D3
+....................
+.................... // Continuously read and display the x,y,z results.
+.................... // Wait at least 67 ms between reads, re the HMC5883L data sheet.
+....................
+....................
+.................... while(TRUE)
+....................   {
+....................
+....................     hmc5883l_read_data();
+F5:  GOTO   151
+....................     printf("%6Ld %6Ld %6Ld \n\r", compass.x, compass.y, compass.z);
+F6:  MOVLW  00
+F7:  MOVWF  04
+F8:  MOVF   22,W
+F9:  MOVWF  38
+FA:  MOVF   21,W
+FB:  MOVWF  37
+FC:  CALL   1D0
+FD:  MOVLW  20
+FE:  MOVWF  40
+FF:  CALL   01F
+:  MOVLW  00
+:  MOVWF  04
+:  MOVF   24,W
+:  MOVWF  38
+:  MOVF   23,W
+:  MOVWF  37
+:  CALL   1D0
+:  MOVLW  20
+:  MOVWF  40
+:  CALL   01F
+A:  MOVLW  00
+B:  MOVWF  04
+C:  MOVF   26,W
+D:  MOVWF  38
+E:  MOVF   25,W
+F:  MOVWF  37
+:  CALL   1D0
+:  MOVLW  20
+:  MOVWF  40
+:  CALL   01F
+:  MOVLW  0A
+:  MOVWF  40
+:  CALL   01F
+:  MOVLW  0D
+:  MOVWF  40
+:  CALL   01F
+....................     delay_ms(100);
+A:  MOVLW  64
+B:  MOVWF  37
+C:  GOTO   250
+....................   }
+D:  GOTO   2F5
+....................
+.................... }
+....................
+....................
+....................
+E:  SLEEP
+Configuration Fuses:
+   Word  1: 2CF5   INTRC NOWDT NOPUT MCLR NOPROTECT NOCPD NOBROWNOUT IESO FCMEN NOLVP NODEBUG
+   Word  2: 3FFF   NOWRT BORV40

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.pjt
 ,0 → 1,31
+[PROJECT]
+Target=main.hex
+Development_Mode=
+Processor_Text=PIC16F887
+ToolSuite=CCS
+Processor=0x887F
+[main]
+Type=4
+Path=
+FileList=
+BuildTool=
+OptionString=
+AdditionalOptionString=
+[mru-list]
+=main.c
+[Windows]
+=0000 %S 0 0 796 451 3 0
+[Opened Files]
+=main.c
+=
+=C:\Program Files (x86)\PICC\devices\16F887.h
+=HMC5883L.h
+=HMC5883L.c
+=C:\Program Files (x86)\PICC\drivers\math.h
+=
+[Target Data]
+OptionString=-p +FM
+FileList=Z:\home\kaklik\svnMLAB\Modules\Sensors\MAG01A\SW\PIC16F887\main.c
+[Units]
+Count=1
+=main (main)

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.sta
 ,0 → 1,60
+ROM used: 799 (10%)
+(10%) including unused fragments
+Average locations per line
+Average locations per statement
+RAM used: 28 (8%) at main() level
+(10%) worst case
+Stack used: 2 worst case (out of 8 total available)
+Lines Stmts  %   Files
+----- ----- ---  -----
+19   6  main.c
+0   0  main.h
+0   0  C:\Program Files (x86)\PICC\devices\16F887.h
+0   0  HMC5883L.h
+28   9  HMC5883L.c
+260  85  C:\Program Files (x86)\PICC\drivers\math.h
+----- -----
+307 Total
+Page ROM  %  RAM   Vol Diff  Functions:
+---- --- --- ---   --- ----  ----------
+22   3   1             @delay_ms1
+69   9   3             @I2C_READ_1
+74   9   1             @I2C_WRITE_1
+36   5   1             @PUTCHAR_1_
+57   7   2   102  1.8  hmc5883l_write_reg
+127  16   6   636  3.3  hmc5883l_read_data
+185  23  16   722  3.9  MAIN
+9   1   0             @const237
+70   9   3             @PSTRINGC7_69
+12   2   0             @const239
+6   1   0             @const240
+128  16   9             @PRINTF_LD_69
+Program metrics:
+    Functions               3
+    Statements              307
+    Comments                358
+    Volume (V)              1829
+    Difficilty (D)          8.6
+    Effort to implement (E) 15712
+    Time to implement (T)   15 minutes
+    Est Delivered Bugs (B)  0
+    Cyclomatic Complexity   1
+    Maintainability (MI)    16
+ Segment     Used  Free
+-----------  ----  ----
+-00003     4  0
+-007FF   795  1249
+-00FFF     0  2048
+-017FF     0  2048
+-01FFF     0  2048

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.sym
 ,0 → 1,102
+-005 @READ_PROGRAM_MEMORY8.P1
+@WRITE_PROGRAM_MEMORY8.P2
+CCP_1_LOW
+CCP_1
+CCP_1_HIGH
+B     CCP_2_LOW
+B     CCP_2
+C     CCP_2_HIGH
+@TRIS_C
+-026 compass
+-02A MAIN.last
+B-02E MAIN.b
+F-032 MAIN.anemo_speed
+-034 MAIN.anemo_round
+-036 MAIN.i
+-038 @PRINTF_LD_69.P1
+hmc5883l_write_reg.reg
+@delay_ms1.P1
+hmc5883l_read_data.x_lsb
+@PSTRINGC7_69.@SCRATCH1
+hmc5883l_read_data.x_msb
+hmc5883l_write_reg.data
+@PSTRINGC7_69.@SCRATCH2
+hmc5883l_read_data.y_lsb
+@PSTRINGC7_69.@SCRATCH3
+@PRINTF_LD_69.@SCRATCH1
+A     hmc5883l_read_data.y_msb
+A     @PRINTF_LD_69.@SCRATCH2
+B     hmc5883l_read_data.z_lsb
+B     @PRINTF_LD_69.@SCRATCH3
+C     hmc5883l_read_data.z_msb
+C     @PRINTF_LD_69.@SCRATCH4
+D     @I2C_READ_1.P1
+D     @I2C_WRITE_1.P2
+D     @PRINTF_LD_69.@SCRATCH5
+E     @I2C_READ_1.@SCRATCH1
+E     @PRINTF_LD_69.@SCRATCH6
+F     @I2C_READ_1.@SCRATCH2
+F     @PRINTF_LD_69.@SCRATCH7
+@PUTCHAR_1_.P1
+@SCRATCH
+@SCRATCH
+_RETURN_
+@SCRATCH
+A     @SCRATCH
+.6   C1OUT
+.6   C2OUT
+D-10E @WRITE_PROGRAM_MEMORY8.P1
+D-10E @READ_PROGRAM_MEMORY8.P2
+ROM Allocation:
+@delay_ms1
+C  @I2C_READ_1
+@I2C_WRITE_1
+F  @PUTCHAR_1_
+D3  hmc5883l_write_reg
+hmc5883l_read_data
+MAIN
+@const237
+@PSTRINGC7_69
+D  @const239
+@const240
+D0  @PRINTF_LD_69
+@cinit
+User Memory space:
+User Memory space:
+Project Directory:
+    Z:\home\kaklik\svnMLAB\Modules\Sensors\MAG01A\SW\PIC16F887\
+Project Files:
+    main.c
+    main.h
+    C:\Program Files (x86)\PICC\devices\16F887.h
+    HMC5883L.h
+    HMC5883L.c
+    C:\Program Files (x86)\PICC\drivers\math.h
+Units:
+    Z:\home\kaklik\svnMLAB\Modules\Sensors\MAG01A\SW\PIC16F887\main (main)
+Compiler Settings:
+    Processor:      PIC16F887
+    Pointer Size:   16
+    ADC Range:      0-255
+    Opt Level:      9
+    Short,Int,Long: UNSIGNED: 1,8,16
+    Float,Double:   32,32
+Output Files:
+    Errors:      main.err
+    Ext Symbols: main.esym
+    INHX8:       main.hex
+    Symbols:     main.sym
+    List:        main.lst
+    Debug/COFF:  main.cof
+    Project:     main.PJT
+    Call Tree:   main.tre
+    Statistics:  main.sta

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.tre
 ,0 → 1,46
+ÀÄmain
+   ÀÄMAIN  0/185  Ram=16
+      ÃÄ??0??
+      ÃÄ@PSTRINGC7_69  0/70  Ram=3
+      ³  ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PSTRINGC7_69  0/70  Ram=3
+      ³  ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PSTRINGC7_69  0/70  Ram=3
+      ³  ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄhmc5883l_write_reg  0/57  Ram=2
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÀÄ@I2C_WRITE_1  0/74  Ram=1
+      ÃÄhmc5883l_write_reg  0/57  Ram=2
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÀÄ@I2C_WRITE_1  0/74  Ram=1
+      ÃÄhmc5883l_write_reg  0/57  Ram=2
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÀÄ@I2C_WRITE_1  0/74  Ram=1
+      ÃÄhmc5883l_read_data  0/127  Ram=6
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_WRITE_1  0/74  Ram=1
+      ³  ÃÄ@I2C_READ_1  0/69  Ram=3
+      ³  ÃÄ@I2C_READ_1  0/69  Ram=3
+      ³  ÃÄ@I2C_READ_1  0/69  Ram=3
+      ³  ÃÄ@I2C_READ_1  0/69  Ram=3
+      ³  ÃÄ@I2C_READ_1  0/69  Ram=3
+      ³  ÀÄ@I2C_READ_1  0/69  Ram=3
+      ÃÄ@PRINTF_LD_69  0/128  Ram=9
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PRINTF_LD_69  0/128  Ram=9
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PRINTF_LD_69  0/128  Ram=9
+      ³  ÀÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ÃÄ@PUTCHAR_1_  0/36  Ram=1
+      ÀÄ@delay_ms1  0/22  Ram=1

 /Modules/Sensors/MAG01A/SW/PIC16F887/main.bak
 ,0 → 1,32
+#include "main.h"
+#include "HMC5883L.h"
+void main()
+{
+  setup_adc_ports(NO_ANALOGS|VSS_VDD);
+  setup_adc(ADC_CLOCK_DIV_2);
+  setup_spi(SPI_SS_DISABLED);
+  setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
+  setup_timer_1(T1_DISABLED);
+  setup_timer_2(T2_DISABLED,0,1);
+  setup_ccp1(CCP_OFF);
+  setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard
+  printf("Magnetometr:  \r\n",);
+  printf("(c)mlab JACHO 2013:  \r\n",);
+  printf("Vysledky z jednotlivych os:\r\n",);
+  signed int16 X,Y,Z;
+  while(true)
+  {
+    printf("Vysledky z jednotlivych os:\r\n",);
+    X = mag_readX();
+    Y = mag_readY();
+    Z = mag_readZ();
+    printf("X: %Ld \r\n", X);
+    printf("Y %Ld \r\n", Y);
+    printf("Z: %Ld \r\n", Z);
+    Delay_ms(500);
+  }
+}

Subversion Repositories – MLAB

/Modules/Sensors/MAG01A/SW/ @ HEAD → /Modules/Sensors/MAG01A/SW @ 2998

Compare Path:	Rev
With Path:	Rev