cgribexlib.c 284 KB
Newer Older
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1

Uwe Schulzweida's avatar
Uwe Schulzweida committed
2
/* Automatically generated by m214003 at 2013-03-05, do not edit */
3

Uwe Schulzweida's avatar
Uwe Schulzweida committed
4
/* CGRIBEXLIB_VERSION="1.6.0" */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
5

Uwe Schulzweida's avatar
Uwe Schulzweida committed
6
7
8
9
#ifdef _ARCH_PWR6
#pragma options nostrict
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
10
11
12
13
14
15
16
17
18
#if defined (HAVE_CONFIG_H)
#  include "config.h"
#endif

#include <string.h>
#include <ctype.h>
#include <stdarg.h>
#include <sys/types.h>

19

Uwe Schulzweida's avatar
Uwe Schulzweida committed
20
21
22
#include "file.h"
#include "dmemory.h"
#include "dtypes.h"
Uwe Schulzweida's avatar
Uwe Schulzweida committed
23
#include "calendar.h"
24
#include "timebase.h"
Uwe Schulzweida's avatar
Uwe Schulzweida committed
25
26
27
28

#ifndef _GRIB_INT_H
#define _GRIB_INT_H

29
30
31
32
#if defined (HAVE_CONFIG_H)
#  include "config.h"
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
33
34
35
36
37
38
#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include <float.h>


Uwe Schulzweida's avatar
Uwe Schulzweida committed
39
40
#if ! defined   (_CGRIBEX_H)
#  include "cgribex.h"
Uwe Schulzweida's avatar
Uwe Schulzweida committed
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
#endif
#if ! defined   (_ERROR_H)
#  include "error.h"
#endif
#if ! defined   (_DTYPES_H)
#  include "dtypes.h"
#endif

#if ! defined   (FALSE)
#  define  FALSE  0
#endif

#if ! defined   (TRUE)
#  define  TRUE  1
#endif

#if ! defined   (UCHAR)
#  define  UCHAR  unsigned char
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
61

Uwe Schulzweida's avatar
Uwe Schulzweida committed
62
#if defined (CRAY) || defined (SX) || defined (__uxpch__)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
63
64
65
#  define VECTORCODE
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
66

Uwe Schulzweida's avatar
Uwe Schulzweida committed
67
#if defined (VECTORCODE)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
68
#if  defined  (INT32)
69
#  define  GRIBPACK     unsigned INT32
Uwe Schulzweida's avatar
Uwe Schulzweida committed
70
71
72
#  define  PACK_GRIB    packInt32
#  define  UNPACK_GRIB  unpackInt32
#else
73
#  define  GRIBPACK     unsigned INT64
Uwe Schulzweida's avatar
Uwe Schulzweida committed
74
75
76
#  define  PACK_GRIB    packInt64
#  define  UNPACK_GRIB  unpackInt64
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
77
78
79
#else
#  define  GRIBPACK     unsigned char
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
80

Uwe Schulzweida's avatar
Uwe Schulzweida committed
81
82
#define  U_BYTEORDER     static union {unsigned long l; unsigned char c[sizeof(long)];} u_byteorder = {1}
#define  IS_BIGENDIAN()  (u_byteorder.c[sizeof(long) - 1])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
83

Uwe Schulzweida's avatar
Uwe Schulzweida committed
84
#if defined (__xlC__) /* performance problems on IBM */
Uwe Schulzweida's avatar
cleanup    
Uwe Schulzweida committed
85
86
87
88
#ifndef DBL_IS_NAN
#  define DBL_IS_NAN(x)     ((x) != (x))
#endif
#else
89
#ifndef DBL_IS_NAN
Uwe Schulzweida's avatar
Uwe Schulzweida committed
90
#if  defined  (HAVE_DECL_ISNAN)
91
#  define DBL_IS_NAN(x)     (isnan(x))
92
#elif  defined  (FP_NAN)
93
94
95
96
97
#  define DBL_IS_NAN(x)     (fpclassify(x) == FP_NAN)
#else
#  define DBL_IS_NAN(x)     ((x) != (x))
#endif
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
98
#endif
99

100
101
102
103
104
#ifndef DBL_IS_EQUAL
/*#define DBL_IS_EQUAL(x,y) (!(x < y || y < x)) */
#  define DBL_IS_EQUAL(x,y) (DBL_IS_NAN(x)||DBL_IS_NAN(y)?(DBL_IS_NAN(x)&&DBL_IS_NAN(y)?1:0):!(x < y || y < x))
#endif

105
106
107
#ifndef IS_EQUAL
#  define IS_NOT_EQUAL(x,y) (x < y || y < x)
#  define IS_EQUAL(x,y)     (!IS_NOT_EQUAL(x,y))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
108
109
110
#endif


111
112
113
#define  JP23SET    0x7FFFFF  /* 2**23 - 1 (---> 8388607)  */

#define  POW_2_M24  0.000000059604644775390625  /*  pow(2.0, -24.0) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
114
115
116

double intpow2(int x);

117
118
119
int gribrec_len(int b1, int b2, int b3);
int correct_bdslen(int bdslen, long recsize, long gribpos);

Uwe Schulzweida's avatar
Uwe Schulzweida committed
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
/* CDI converter routines */

/* param format:  DDDCCCNNN */

void    cdiDecodeParam(int param, int *dis, int *cat, int *num);
int     cdiEncodeParam(int dis, int cat, int num);

/* date format:  YYYYMMDD */
/* time format:  hhmmss   */

void    cdiDecodeDate(int date, int *year, int *month, int *day);
int     cdiEncodeDate(int year, int month, int day);

void    cdiDecodeTime(int time, int *hour, int *minute, int *second);
int     cdiEncodeTime(int hour, int minute, int second);

Uwe Schulzweida's avatar
Uwe Schulzweida committed
136
137
138
139
140
141
142
143
/* CALENDAR types */

#define  CALENDAR_STANDARD        0  /* don't change this value (used also in cgribexlib)! */
#define  CALENDAR_PROLEPTIC       1
#define  CALENDAR_360DAYS         2
#define  CALENDAR_365DAYS         3
#define  CALENDAR_366DAYS         4
#define  CALENDAR_NONE            5
Uwe Schulzweida's avatar
Uwe Schulzweida committed
144
145
146

extern FILE *grprsm;

Uwe Schulzweida's avatar
Uwe Schulzweida committed
147
extern int  CGRIBEX_Debug;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
148
149
150
151
152
153
154
155
156
157

void   gprintf(const char *caller, const char *fmt, ...);

void   grsdef(void);

void   prtbin(int kin, int knbit, int *kout, int *kerr);
void   confp3(double pval, int *kexp, int *kmant, int kbits, int kround);
double decfp2(int kexp, int kmant);
void   ref2ibm(double *pref, int kbits);

Uwe Schulzweida's avatar
Uwe Schulzweida committed
158
159
160
161
void   scaleComplex(double *fpdata, int pcStart, int pcScale, int trunc, int inv);
void   scatterComplex(double *fpdata, int pcStart, int trunc, int nsp);
void   gatherComplex(double *fpdata, int pcStart, int trunc, int nsp);

Uwe Schulzweida's avatar
Uwe Schulzweida committed
162
163
164
void   scm0(double *pdl, double *pdr, double *pfl, double *pfr, int klg);
int    rowina2(double *p, int ko, int ki, double *pw,
	       int kcode, double msval, int *kret);
165
int    rowina3(double *p, int ko, int ki, double *pw,
Uwe Schulzweida's avatar
Uwe Schulzweida committed
166
	       int kcode, double msval, int *kret, int omisng, int operio, int oveggy);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
167
168
int    qu2reg2(double *pfield, int *kpoint, int klat, int klon,
	       double *ztemp, double msval, int *kret);
169
int    qu2reg3(double *pfield, int *kpoint, int klat, int klon,
Uwe Schulzweida's avatar
Uwe Schulzweida committed
170
	       double msval, int *kret, int omisng, int operio, int oveggy);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
171
172

#if  defined  (INT32)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
173
long   packInt32(unsigned INT32 *up, unsigned char *cp, long bc, long tc);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
174
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
175
long   packInt64(unsigned INT64 *up, unsigned char *cp, long bc, long tc);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
176
#if  defined  (INT32)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
177
long   unpackInt32(unsigned char *cp, unsigned INT32 *up, long bc, long tc);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
178
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
179
long   unpackInt64(unsigned char *cp, unsigned INT64 *up, long bc, long tc);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197

void  gribEncode(int *isec0, int *isec1, int *isec2, double *fsec2, int *isec3,
		 double *fsec3, int *isec4, double *fsec4, int klenp, int *kgrib,
		 int kleng, int *kword, int efunc, int *kret);

void  gribDecode(int *isec0, int *isec1, int *isec2, double *fsec2, int *isec3,
		 double *fsec3, int *isec4, double *fsec4, int klenp, int *kgrib,
		 int kleng, int *kword, int dfunc, int *kret);

#endif  /* _GRIB_INT_H */
#ifndef _GRIBDECODE_H
#define _GRIBDECODE_H

#define  UNDEFINED          9.999e20


#define  GET_INT3(a,b,c)    ((1-(int) ((unsigned) (a & 128) >> 6)) * (int) (((a & 127) << 16)+(b<<8)+c))
#define  GET_INT2(a,b)      ((1-(int) ((unsigned) (a & 128) >> 6)) * (int) (((a & 127) << 8) + b))
198
#define  GET_INT1(a)        ((1-(int) ((unsigned) (a & 128) >> 6)) * (int) (a&127))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
199
200
201
202
203
204
205

/* this requires a 32-bit default integer machine */
#define  GET_UINT4(a,b,c,d) ((int) ((a << 24) + (b << 16) + (c << 8) + (d)))
#define  GET_UINT3(a,b,c)   ((int) ((a << 16) + (b << 8)  + (c)))
#define  GET_UINT2(a,b)     ((int) ((a << 8)  + (b)))
#define  GET_UINT1(a)       ((int)  (a))

Uwe Schulzweida's avatar
Uwe Schulzweida committed
206
207
208
#define  BUDG_START(s)      (s[0]=='B' && s[1]=='U' && s[2]=='D' && s[3]=='G')
#define  TIDE_START(s)      (s[0]=='T' && s[1]=='I' && s[2]=='D' && s[3]=='E')
#define  GRIB_START(s)      (s[0]=='G' && s[1]=='R' && s[2]=='I' && s[3]=='B')
Uwe Schulzweida's avatar
Uwe Schulzweida committed
209
#define  GRIB_FIN(s)        (s[0]=='7' && s[1]=='7' && s[2]=='7' && s[3]=='7')
Uwe Schulzweida's avatar
Uwe Schulzweida committed
210

Uwe Schulzweida's avatar
Uwe Schulzweida committed
211
/* GRIB1 Section 0: Indicator Section (IS) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
212

213
#define  GRIB1_SECLEN(s)     GET_INT3(s[ 4], s[ 5], s[ 6])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
214
#define  GRIB_EDITION(s)     GET_UINT1(s[ 7])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
215

Uwe Schulzweida's avatar
Uwe Schulzweida committed
216
/* GRIB1 Section 1: Product Definition Section (PDS) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
217
218
219
220
221
222
223
224
225
226
227
228
229
230

#define  PDS_Len             GET_UINT3(pds[ 0], pds[ 1], pds[ 2])
#define  PDS_CodeTable       GET_UINT1(pds[ 3])
#define  PDS_CenterID        GET_UINT1(pds[ 4])
#define  PDS_ModelID         GET_UINT1(pds[ 5])
#define  PDS_GridDefinition  GET_UINT1(pds[ 6])
#define  PDS_Sec2Or3Flag     GET_UINT1(pds[ 7])
#define  PDS_HAS_GDS         ((pds[7] & 128) != 0)
#define  PDS_HAS_BMS         ((pds[7] &  64) != 0)
#define  PDS_Parameter       GET_UINT1(pds[ 8])
#define  PDS_LevelType       GET_UINT1(pds[ 9])
#define  PDS_Level1          (pds[10])
#define  PDS_Level2	     (pds[11])
#define  PDS_Level	     GET_UINT2(pds[10], pds[11])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
231
#define  PDS_Year            GET_INT1(pds[12])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
#define  PDS_Month           GET_UINT1(pds[13])
#define  PDS_Day             GET_UINT1(pds[14])
#define  PDS_Hour            GET_UINT1(pds[15])
#define  PDS_Minute          GET_UINT1(pds[16])
#define  PDS_Date            (PDS_Year*10000+PDS_Month*100+PDS_Day)
#define  PDS_Time            (PDS_Hour*100+PDS_Minute)
#define  PDS_TimeUnit        GET_UINT1(pds[17])
#define  PDS_TimePeriod1     GET_UINT1(pds[18])
#define  PDS_TimePeriod2     GET_UINT1(pds[19])
#define  PDS_TimeRange       GET_UINT1(pds[20])
#define  PDS_AvgNum          GET_UINT2(pds[21], pds[22])
#define  PDS_AvgMiss         GET_UINT1(pds[23])
#define  PDS_Century         GET_UINT1(pds[24])
#define  PDS_Subcenter       GET_UINT1(pds[25])
#define  PDS_DecimalScale    GET_INT2(pds[26],pds[27])


Uwe Schulzweida's avatar
Uwe Schulzweida committed
249
/* GRIB1 Section 2: Grid Description Section (GDS) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
250
251
252
253

#define  GDS_Len             ((gds) == NULL ? 0 : GET_UINT3(gds[ 0], gds[ 1], gds[ 2]))
#define  GDS_NV              GET_UINT1(gds[ 3])
#define  GDS_PVPL            GET_UINT1(gds[ 4])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
254
255
#define  GDS_PV	             ((gds[3] ==    0) ? -1 : (int) gds[4] - 1)
#define  GDS_PL	             ((gds[4] == 0xFF) ? -1 : (int) gds[3] * 4 + (int) gds[4] - 1)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
256
257
258
#define  GDS_GridType        GET_UINT1(gds[ 5])


Uwe Schulzweida's avatar
Uwe Schulzweida committed
259
/* GRIB1 Triangular grid of DWD */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
260
261
262
263
264
265
266
267
268
269
#define  GDS_GME_NI2         GET_UINT2(gds[ 6], gds[ 7])
#define  GDS_GME_NI3         GET_UINT2(gds[ 8], gds[ 9])
#define  GDS_GME_ND          GET_UINT3(gds[10], gds[11], gds[12])
#define  GDS_GME_NI          GET_UINT3(gds[13], gds[14], gds[15])
#define  GDS_GME_AFlag       GET_UINT1(gds[16])
#define  GDS_GME_LatPP       GET_INT3(gds[17], gds[18], gds[19])
#define  GDS_GME_LonPP       GET_INT3(gds[20], gds[21], gds[22])
#define  GDS_GME_LonMPL      GET_INT3(gds[23], gds[24], gds[25])
#define  GDS_GME_BFlag       GET_UINT1(gds[27])

Uwe Schulzweida's avatar
Uwe Schulzweida committed
270
/* GRIB1 Spectral */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
271
272
273
274
275
276
#define  GDS_PentaJ          GET_UINT2(gds[ 6], gds[ 7])
#define  GDS_PentaK          GET_UINT2(gds[ 8], gds[ 9])
#define  GDS_PentaM          GET_UINT2(gds[10], gds[11])
#define  GDS_RepType         GET_UINT1(gds[12])
#define  GDS_RepMode         GET_UINT1(gds[13])

Uwe Schulzweida's avatar
Uwe Schulzweida committed
277
/* GRIB1 Regular grid */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
278
279
280
281
282
283
284
#define  GDS_NumLon          GET_UINT2(gds[ 6], gds[ 7])
#define  GDS_NumLat          GET_UINT2(gds[ 8], gds[ 9])
#define  GDS_FirstLat        GET_INT3(gds[10], gds[11], gds[12])
#define  GDS_FirstLon        GET_INT3(gds[13], gds[14], gds[15])
#define  GDS_ResFlag         GET_UINT1(gds[16])
#define  GDS_LastLat         GET_INT3(gds[17], gds[18], gds[19])
#define  GDS_LastLon         GET_INT3(gds[20], gds[21], gds[22])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
285
286
287
#define  GDS_LonIncr         GET_UINT2(gds[23], gds[24])
#define  GDS_LatIncr         GET_UINT2(gds[25], gds[26])
#define  GDS_NumPar          GET_UINT2(gds[25], gds[26])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
288
289
290
291
292
#define  GDS_ScanFlag        GET_UINT1(gds[27])
#define  GDS_LatSP           GET_INT3(gds[32], gds[33], gds[34])
#define  GDS_LonSP           GET_INT3(gds[35], gds[36], gds[37])
#define  GDS_RotAngle        GET_Real(&(gds[38]))

Uwe Schulzweida's avatar
Uwe Schulzweida committed
293
/* GRIB1 Lambert */
294
295
296
297
298
299
300
301
#define  GDS_Lambert_Lov     GET_INT3(gds[17], gds[18], gds[19])
#define  GDS_Lambert_dx	     GET_INT3(gds[20], gds[21], gds[22])
#define  GDS_Lambert_dy	     GET_INT3(gds[23], gds[24], gds[25])
#define  GDS_Lambert_ProjFlag GET_UINT1(gds[26])
#define  GDS_Lambert_LatS1   GET_INT3(gds[28], gds[29], gds[30])
#define  GDS_Lambert_LatS2   GET_INT3(gds[31], gds[32], gds[33])
#define  GDS_Lambert_LatSP   GET_INT3(gds[34], gds[35], gds[36])
#define  GDS_Lambert_LonSP   GET_INT3(gds[37], gds[37], gds[37])
302

Uwe Schulzweida's avatar
Uwe Schulzweida committed
303
/* GRIB1 Section 3: Bit Map Section (BMS) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
304
305
306
307
308
309
310

#define  BMS_Len	     ((bms) == NULL ? 0 : (int) (bms[0]<<16)+(bms[1]<<8)+bms[2])
#define  BMS_UnusedBits      (bms[3])
#define  BMS_Numeric         
#define  BMS_Bitmap	     ((bms) == NULL ? NULL : (bms)+6)
#define  BMS_BitmapSize      (((((bms[0]<<16)+(bms[1]<<8)+bms[2]) - 6)<<3) - bms[3])

Uwe Schulzweida's avatar
Uwe Schulzweida committed
311
/* GRIB1 Section 4: Binary Data Section (BDS) */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
312
313
314
315
316
317
318

#define  BDS_Len	    ((int) ((bds[0]<<16)+(bds[1]<<8)+bds[2]))
#define  BDS_Flag	    (bds[3])
#define  BDS_BinScale       GET_INT2(bds[ 4], bds[ 5])
#define  BDS_RefValue       decfp2((int)bds[ 6], GET_UINT3(bds[ 7], bds[ 8], bds[ 9]))
#define  BDS_NumBits        ((int) bds[10])
#define  BDS_RealCoef       decfp2((int)bds[zoff+11], GET_UINT3(bds[zoff+12], bds[zoff+13], bds[zoff+14]))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
319
320
#define  BDS_PackData       ((int) ((bds[zoff+11]<<8) + bds[zoff+12]))
#define  BDS_Power          GET_INT2(bds[zoff+13], bds[zoff+14])
Uwe Schulzweida's avatar
Uwe Schulzweida committed
321
322
#define  BDS_Z              (bds[13])

Uwe Schulzweida's avatar
Uwe Schulzweida committed
323
324
325
326
327
328
/* GRIB1 Section 5: End Section (ES) */

/* GRIB2 */

#define  GRIB2_SECLEN(section)   (GET_UINT4(section[0], section[1], section[2], section[3]))
#define  GRIB2_SECNUM(section)   (GET_UINT1(section[4]))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347

#endif  /* _GRIBDECODE_H */
#ifndef _GRIBENCODE_H
#define _GRIBENCODE_H


#define PutnZero(n) \
{ \
  int i; \
  for ( i = z; i < z+n; i++ ) lGrib[i] = 0; \
  z += n; \
}

#define Put1Byte(Value)  (lGrib[z++] = (Value))
#define Put2Byte(Value) ((lGrib[z++] = (Value) >>  8), \
                         (lGrib[z++] = (Value)))
#define Put3Byte(Value) ((lGrib[z++] = (Value) >> 16), \
                         (lGrib[z++] = (Value) >>  8), \
                         (lGrib[z++] = (Value)))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
348
349
350
351
#define Put4Byte(Value) ((lGrib[z++] = (Value) >> 24), \
                         (lGrib[z++] = (Value) >> 16), \
                         (lGrib[z++] = (Value) >>  8), \
                         (lGrib[z++] = (Value)))
Uwe Schulzweida's avatar
Uwe Schulzweida committed
352

Uwe Schulzweida's avatar
Uwe Schulzweida committed
353
354
355
#define Put1Int(Value)  {ival = Value; if ( ival < 0 ) ival =     0x80 - ival; Put1Byte(ival);}
#define Put2Int(Value)  {ival = Value; if ( ival < 0 ) ival =   0x8000 - ival; Put2Byte(ival);}
#define Put3Int(Value)  {ival = Value; if ( ival < 0 ) ival = 0x800000 - ival; Put3Byte(ival);}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
356
357
358
359
360
361
362
363
364

#define Put1Real(Value)          \
{                                \
  confp3(Value, &exponent, &mantissa, BitsPerInt, 1); \
  Put1Byte(exponent);            \
  Put3Byte(mantissa);            \
}

#endif  /* _GRIBENCODE_H */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
365
366
#include <stdio.h>
#include <math.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
367
368


Uwe Schulzweida's avatar
Uwe Schulzweida committed
369
const double const _pow2tab[158] = {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
 /* pow(2.0,  0.0) */  1.0,
 /* pow(2.0,  1.0) */  2.0,
 /* pow(2.0,  2.0) */  4.0,
 /* pow(2.0,  3.0) */  8.0,
 /* pow(2.0,  4.0) */  16.0,
 /* pow(2.0,  5.0) */  32.0,
 /* pow(2.0,  6.0) */  64.0,
 /* pow(2.0,  7.0) */  128.0,
 /* pow(2.0,  8.0) */  256.0,
 /* pow(2.0,  9.0) */  512.0,
 /* pow(2.0, 10.0) */  1024.0,
 /* pow(2.0, 11.0) */  2048.0,
 /* pow(2.0, 12.0) */  4096.0,
 /* pow(2.0, 13.0) */  8192.0,
 /* pow(2.0, 14.0) */  16384.0,
 /* pow(2.0, 15.0) */  32768.0,
 /* pow(2.0, 16.0) */  65536.0,
 /* pow(2.0, 17.0) */  131072.0,
 /* pow(2.0, 18.0) */  262144.0,
 /* pow(2.0, 19.0) */  524288.0,
 /* pow(2.0, 20.0) */  1048576.0,
 /* pow(2.0, 21.0) */  2097152.0,
 /* pow(2.0, 22.0) */  4194304.0,
 /* pow(2.0, 23.0) */  8388608.0,
 /* pow(2.0, 24.0) */  16777216.0,
 /* pow(2.0, 25.0) */  33554432.0,
 /* pow(2.0, 26.0) */  67108864.0,
 /* pow(2.0, 27.0) */  134217728.0,
 /* pow(2.0, 28.0) */  268435456.0,
 /* pow(2.0, 29.0) */  536870912.0,
 /* pow(2.0, 30.0) */  1073741824.0,
 /* pow(2.0, 31.0) */  2147483648.0,
 /* pow(2.0, 32.0) */  4294967296.0,
 /* pow(2.0, 33.0) */  8589934592.0,
 /* pow(2.0, 34.0) */  17179869184.0,
 /* pow(2.0, 35.0) */  34359738368.0,
 /* pow(2.0, 36.0) */  68719476736.0,
 /* pow(2.0, 37.0) */  137438953472.0,
 /* pow(2.0, 38.0) */  274877906944.0,
 /* pow(2.0, 39.0) */  549755813888.0,
 /* pow(2.0, 40.0) */  1099511627776.0,
 /* pow(2.0, 41.0) */  2199023255552.0,
 /* pow(2.0, 42.0) */  4398046511104.0,
 /* pow(2.0, 43.0) */  8796093022208.0,
 /* pow(2.0, 44.0) */  17592186044416.0,
 /* pow(2.0, 45.0) */  35184372088832.0,
 /* pow(2.0, 46.0) */  70368744177664.0,
 /* pow(2.0, 47.0) */  140737488355328.0,
 /* pow(2.0, 48.0) */  281474976710656.0,
 /* pow(2.0, 49.0) */  562949953421312.0,
 /* pow(2.0, 50.0) */  1125899906842624.0,
 /* pow(2.0, 51.0) */  2251799813685248.0,
 /* pow(2.0, 52.0) */  4503599627370496.0,
 /* pow(2.0, 53.0) */  9007199254740992.0,
 /* pow(2.0, 54.0) */  18014398509481984.0,
 /* pow(2.0, 55.0) */  36028797018963968.0,
 /* pow(2.0, 56.0) */  72057594037927936.0,
 /* pow(2.0, 57.0) */  144115188075855872.0,
 /* pow(2.0, 58.0) */  288230376151711744.0,
 /* pow(2.0, 59.0) */  576460752303423488.0,
 /* pow(2.0, 60.0) */  1152921504606846976.0,
 /* pow(2.0, 61.0) */  2305843009213693952.0,
 /* pow(2.0, 62.0) */  4611686018427387904.0,
 /* pow(2.0, 63.0) */  9223372036854775808.0,
 /* pow(2.0, 64.0) */  18446744073709551616.0,
 /* pow(2.0, 65.0) */  36893488147419103232.0,
 /* pow(2.0, 66.0) */  73786976294838206464.0,
 /* pow(2.0, 67.0) */  147573952589676412928.0,
 /* pow(2.0, 68.0) */  295147905179352825856.0,
 /* pow(2.0, 69.0) */  590295810358705651712.0,
 /* pow(2.0, 70.0) */  1180591620717411303424.0,
 /* pow(2.0, 71.0) */  2361183241434822606848.0,
 /* pow(2.0, 72.0) */  4722366482869645213696.0,
 /* pow(2.0, 73.0) */  9444732965739290427392.0,
 /* pow(2.0, 74.0) */  18889465931478580854784.0,
 /* pow(2.0, 75.0) */  37778931862957161709568.0,
 /* pow(2.0, 76.0) */  75557863725914323419136.0,
 /* pow(2.0, 77.0) */  151115727451828646838272.0,
 /* pow(2.0, 78.0) */  302231454903657293676544.0,
 /* pow(2.0, 79.0) */  604462909807314587353088.0,
 /* pow(2.0, 80.0) */  1208925819614629174706176.0,
 /* pow(2.0, 81.0) */  2417851639229258349412352.0,
 /* pow(2.0, 82.0) */  4835703278458516698824704.0,
 /* pow(2.0, 83.0) */  9671406556917033397649408.0,
 /* pow(2.0, 84.0) */  19342813113834066795298816.0,
 /* pow(2.0, 85.0) */  38685626227668133590597632.0,
 /* pow(2.0, 86.0) */  77371252455336267181195264.0,
 /* pow(2.0, 87.0) */  154742504910672534362390528.0,
 /* pow(2.0, 88.0) */  309485009821345068724781056.0,
 /* pow(2.0, 89.0) */  618970019642690137449562112.0,
 /* pow(2.0, 90.0) */  1237940039285380274899124224.0,
 /* pow(2.0, 91.0) */  2475880078570760549798248448.0,
 /* pow(2.0, 92.0) */  4951760157141521099596496896.0,
 /* pow(2.0, 93.0) */  9903520314283042199192993792.0,
 /* pow(2.0, 94.0) */  19807040628566084398385987584.0,
 /* pow(2.0, 95.0) */  39614081257132168796771975168.0,
 /* pow(2.0, 96.0) */  79228162514264337593543950336.0,
 /* pow(2.0, 97.0) */  158456325028528675187087900672.0,
 /* pow(2.0, 98.0) */  316912650057057350374175801344.0,
 /* pow(2.0, 99.0) */  633825300114114700748351602688.0,
 /* pow(2.0, 100.0) */  1267650600228229401496703205376.0,
 /* pow(2.0, 101.0) */  2535301200456458802993406410752.0,
 /* pow(2.0, 102.0) */  5070602400912917605986812821504.0,
 /* pow(2.0, 103.0) */  10141204801825835211973625643008.0,
 /* pow(2.0, 104.0) */  20282409603651670423947251286016.0,
 /* pow(2.0, 105.0) */  40564819207303340847894502572032.0,
 /* pow(2.0, 106.0) */  81129638414606681695789005144064.0,
 /* pow(2.0, 107.0) */  162259276829213363391578010288128.0,
 /* pow(2.0, 108.0) */  324518553658426726783156020576256.0,
 /* pow(2.0, 109.0) */  649037107316853453566312041152512.0,
 /* pow(2.0, 110.0) */  1298074214633706907132624082305024.0,
 /* pow(2.0, 111.0) */  2596148429267413814265248164610048.0,
 /* pow(2.0, 112.0) */  5192296858534827628530496329220096.0,
 /* pow(2.0, 113.0) */  10384593717069655257060992658440192.0,
 /* pow(2.0, 114.0) */  20769187434139310514121985316880384.0,
 /* pow(2.0, 115.0) */  41538374868278621028243970633760768.0,
 /* pow(2.0, 116.0) */  83076749736557242056487941267521536.0,
 /* pow(2.0, 117.0) */  166153499473114484112975882535043072.0,
 /* pow(2.0, 118.0) */  332306998946228968225951765070086144.0,
 /* pow(2.0, 119.0) */  664613997892457936451903530140172288.0,
 /* pow(2.0, 120.0) */  1329227995784915872903807060280344576.0,
 /* pow(2.0, 121.0) */  2658455991569831745807614120560689152.0,
 /* pow(2.0, 122.0) */  5316911983139663491615228241121378304.0,
 /* pow(2.0, 123.0) */  10633823966279326983230456482242756608.0,
 /* pow(2.0, 124.0) */  21267647932558653966460912964485513216.0,
 /* pow(2.0, 125.0) */  42535295865117307932921825928971026432.0,
 /* pow(2.0, 126.0) */  85070591730234615865843651857942052864.0,
 /* pow(2.0, 127.0) */  170141183460469231731687303715884105728.0,
 /* pow(2.0, 128.0) */  340282366920938463463374607431768211456.0,
 /* pow(2.0, 129.0) */  680564733841876926926749214863536422912.0,
 /* pow(2.0, 130.0) */  1361129467683753853853498429727072845824.0,
 /* pow(2.0, 131.0) */  2722258935367507707706996859454145691648.0,
 /* pow(2.0, 132.0) */  5444517870735015415413993718908291383296.0,
 /* pow(2.0, 133.0) */  10889035741470030830827987437816582766592.0,
 /* pow(2.0, 134.0) */  21778071482940061661655974875633165533184.0,
 /* pow(2.0, 135.0) */  43556142965880123323311949751266331066368.0,
 /* pow(2.0, 136.0) */  87112285931760246646623899502532662132736.0,
 /* pow(2.0, 137.0) */  174224571863520493293247799005065324265472.0,
 /* pow(2.0, 138.0) */  348449143727040986586495598010130648530944.0,
 /* pow(2.0, 139.0) */  696898287454081973172991196020261297061888.0,
 /* pow(2.0, 140.0) */  1393796574908163946345982392040522594123776.0,
 /* pow(2.0, 141.0) */  2787593149816327892691964784081045188247552.0,
 /* pow(2.0, 142.0) */  5575186299632655785383929568162090376495104.0,
 /* pow(2.0, 143.0) */  11150372599265311570767859136324180752990208.0,
 /* pow(2.0, 144.0) */  22300745198530623141535718272648361505980416.0,
 /* pow(2.0, 145.0) */  44601490397061246283071436545296723011960832.0,
 /* pow(2.0, 146.0) */  89202980794122492566142873090593446023921664.0,
 /* pow(2.0, 147.0) */  178405961588244985132285746181186892047843328.0,
 /* pow(2.0, 148.0) */  356811923176489970264571492362373784095686656.0,
 /* pow(2.0, 149.0) */  713623846352979940529142984724747568191373312.0,
 /* pow(2.0, 150.0) */  1427247692705959881058285969449495136382746624.0,
 /* pow(2.0, 151.0) */  2854495385411919762116571938898990272765493248.0,
 /* pow(2.0, 152.0) */  5708990770823839524233143877797980545530986496.0,
 /* pow(2.0, 153.0) */  11417981541647679048466287755595961091061972992.0,
 /* pow(2.0, 154.0) */  22835963083295358096932575511191922182123945984.0,
 /* pow(2.0, 155.0) */  45671926166590716193865151022383844364247891968.0,
 /* pow(2.0, 156.0) */  91343852333181432387730302044767688728495783936.0,
 /* pow(2.0, 157.0) */  182687704666362864775460604089535377456991567872.0,
};


Uwe Schulzweida's avatar
Uwe Schulzweida committed
531
const double const _pow16tab[71] = {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
 /* pow(16.0,  0.0) */  1.0,
 /* pow(16.0,  1.0) */  16.0,
 /* pow(16.0,  2.0) */  256.0,
 /* pow(16.0,  3.0) */  4096.0,
 /* pow(16.0,  4.0) */  65536.0,
 /* pow(16.0,  5.0) */  1048576.0,
 /* pow(16.0,  6.0) */  16777216.0,
 /* pow(16.0,  7.0) */  268435456.0,
 /* pow(16.0,  8.0) */  4294967296.0,
 /* pow(16.0,  9.0) */  68719476736.0,
 /* pow(16.0, 10.0) */  1099511627776.0,
 /* pow(16.0, 11.0) */  17592186044416.0,
 /* pow(16.0, 12.0) */  281474976710656.0,
 /* pow(16.0, 13.0) */  4503599627370496.0,
 /* pow(16.0, 14.0) */  72057594037927936.0,
 /* pow(16.0, 15.0) */  1152921504606846976.0,
 /* pow(16.0, 16.0) */  18446744073709551616.0,
 /* pow(16.0, 17.0) */  295147905179352825856.0,
 /* pow(16.0, 18.0) */  4722366482869645213696.0,
 /* pow(16.0, 19.0) */  75557863725914323419136.0,
 /* pow(16.0, 20.0) */  1208925819614629174706176.0,
 /* pow(16.0, 21.0) */  19342813113834066795298816.0,
 /* pow(16.0, 22.0) */  309485009821345068724781056.0,
 /* pow(16.0, 23.0) */  4951760157141521099596496896.0,
 /* pow(16.0, 24.0) */  79228162514264337593543950336.0,
 /* pow(16.0, 25.0) */  1267650600228229401496703205376.0,
 /* pow(16.0, 26.0) */  20282409603651670423947251286016.0,
 /* pow(16.0, 27.0) */  324518553658426726783156020576256.0,
 /* pow(16.0, 28.0) */  5192296858534827628530496329220096.0,
 /* pow(16.0, 29.0) */  83076749736557242056487941267521536.0,
 /* pow(16.0, 30.0) */  1329227995784915872903807060280344576.0,
 /* pow(16.0, 31.0) */  21267647932558653966460912964485513216.0,
 /* pow(16.0, 32.0) */  340282366920938463463374607431768211456.0,
 /* pow(16.0, 33.0) */  5444517870735015415413993718908291383296.0,
 /* pow(16.0, 34.0) */  87112285931760246646623899502532662132736.0,
 /* pow(16.0, 35.0) */  1393796574908163946345982392040522594123776.0,
 /* pow(16.0, 36.0) */  22300745198530623141535718272648361505980416.0,
 /* pow(16.0, 37.0) */  356811923176489970264571492362373784095686656.0,
 /* pow(16.0, 38.0) */  5708990770823839524233143877797980545530986496.0,
 /* pow(16.0, 39.0) */  91343852333181432387730302044767688728495783936.0,
 /* pow(16.0, 40.0) */  1461501637330902918203684832716283019655932542976.0,
 /* pow(16.0, 41.0) */  23384026197294446691258957323460528314494920687616.0,
 /* pow(16.0, 42.0) */  374144419156711147060143317175368453031918731001856.0,
 /* pow(16.0, 43.0) */  5986310706507378352962293074805895248510699696029696.0,
 /* pow(16.0, 44.0) */  95780971304118053647396689196894323976171195136475136.0,
 /* pow(16.0, 45.0) */  1532495540865888858358347027150309183618739122183602176.0,
 /* pow(16.0, 46.0) */  24519928653854221733733552434404946937899825954937634816.0,
 /* pow(16.0, 47.0) */  392318858461667547739736838950479151006397215279002157056.0,
 /* pow(16.0, 48.0) */  6277101735386680763835789423207666416102355444464034512896.0,
 /* pow(16.0, 49.0) */  100433627766186892221372630771322662657637687111424552206336.0,
 /* pow(16.0, 50.0) */  1606938044258990275541962092341162602522202993782792835301376.0,
 /* pow(16.0, 51.0) */  25711008708143844408671393477458601640355247900524685364822016.0,
 /* pow(16.0, 52.0) */  411376139330301510538742295639337626245683966408394965837152256.0,
 /* pow(16.0, 53.0) */  6582018229284824168619876730229402019930943462534319453394436096.0,
 /* pow(16.0, 54.0) */  105312291668557186697918027683670432318895095400549111254310977536.0,
 /* pow(16.0, 55.0) */  1684996666696914987166688442938726917102321526408785780068975640576.0,
 /* pow(16.0, 56.0) */  26959946667150639794667015087019630673637144422540572481103610249216.0,
 /* pow(16.0, 57.0) */  431359146674410236714672241392314090778194310760649159697657763987456.0,
 /* pow(16.0, 58.0) */  6901746346790563787434755862277025452451108972170386555162524223799296.0,
 /* pow(16.0, 59.0) */  110427941548649020598956093796432407239217743554726184882600387580788736.0,
 /* pow(16.0, 60.0) */  1766847064778384329583297500742918515827483896875618958121606201292619776.0,
 /* pow(16.0, 61.0) */  28269553036454149273332760011886696253239742350009903329945699220681916416.0,
 /* pow(16.0, 62.0) */  452312848583266388373324160190187140051835877600158453279131187530910662656.0,
 /* pow(16.0, 63.0) */  7237005577332262213973186563042994240829374041602535252466099000494570602496.0,
 /* pow(16.0, 64.0) */  115792089237316195423570985008687907853269984665640564039457584007913129639936.0,
 /* pow(16.0, 65.0) */  1852673427797059126777135760139006525652319754650249024631321344126610074238976.0,
 /* pow(16.0, 66.0) */  29642774844752946028434172162224104410437116074403984394101141506025761187823616.0,
 /* pow(16.0, 67.0) */  474284397516047136454946754595585670566993857190463750305618264096412179005177856.0,
 /* pow(16.0, 68.0) */  7588550360256754183279148073529370729071901715047420004889892225542594864082845696.0,
 /* pow(16.0, 69.0) */  121416805764108066932466369176469931665150427440758720078238275608681517825325531136.0,
 /* pow(16.0, 70.0) */  1942668892225729070919461906823518906642406839052139521251812409738904285205208498176.0,
};

static int _pow2tab_size = sizeof(_pow2tab)/sizeof(double);

void gen_pow2tab(void)
{
  int jloop;

  for ( jloop = 0; jloop < 158; jloop++ )
    printf(" /* pow(2.0, %2d.0) */  %.1f,\n", jloop,  pow(2.0, (double) jloop));
}


void gen_pow16tab(void)
{
  double pval;
  int iexp;

  for ( iexp = 0; iexp < 71; iexp++ )
    {
      pval = pow(16.0, (double)(iexp));
      printf(" /* pow(16.0, %2d.0) */  %.1f,\n", iexp, pval);
    }
}


double intpow2(int x)
{
  if ( x < _pow2tab_size )
    return (_pow2tab[x]);
  else
    return (pow(2.0, (double) x));
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
636
//#undef _GET_X86_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
637
//#undef _GET_IBM_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
638
//#undef _GET_MACH_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
639
//#undef _ARCH_PWR6
Uwe Schulzweida's avatar
Uwe Schulzweida committed
640

Uwe Schulzweida's avatar
Uwe Schulzweida committed
641
642
#if   defined(__GNUC__) && (__GNUC__ >= 4)
#elif defined(__ICC)    && (__ICC >= 1100)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
643
#elif defined(__clang__)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
644
645
646
647
#else
#define DISABLE_SIMD
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
648
#if defined _GET_IBM_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
649
#include <libhpc.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
650
#elif defined _GET_X86_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
651
#include <x86intrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
652
#elif defined _GET_MACH_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
653
#include <mach/mach_time.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
654
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
655

Uwe Schulzweida's avatar
Uwe Schulzweida committed
656
//#define DISABLE_SIMD
Uwe Schulzweida's avatar
Uwe Schulzweida committed
657

Uwe Schulzweida's avatar
Uwe Schulzweida committed
658
659
660
#ifdef DISABLE_SIMD
#ifndef ENABLE_AVX
#undef __AVX__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
661
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
662
663
#ifndef ENABLE_SSE2
#undef __SSE2__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
664
665
#endif
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
666

Uwe Schulzweida's avatar
Uwe Schulzweida committed
667
#if defined __AVX__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
668
669
670
671
#include <float.h>
#include <stdint.h>
#include <inttypes.h>
#include <immintrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
672
#elif defined __SSE2__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
673
674
675
676
#include <float.h>
#include <stdint.h>
#include <inttypes.h>
#include <emmintrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
677
678
679
680
#endif

#if defined __AVX__

Uwe Schulzweida's avatar
Uwe Schulzweida committed
681
static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
682
void avx_minmax_val(const double *restrict buf, size_t nframes, double *min, double *max)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
683
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
684
  double fmin[4], fmax[4];
Uwe Schulzweida's avatar
Uwe Schulzweida committed
685
  __m256d current_max, current_min, work;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
686

Uwe Schulzweida's avatar
Uwe Schulzweida committed
687
  // load max and min values into all four slots of the YMM registers
Uwe Schulzweida's avatar
Uwe Schulzweida committed
688
689
  current_min = _mm256_set1_pd(*min);
  current_max = _mm256_set1_pd(*max);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
690

Uwe Schulzweida's avatar
Uwe Schulzweida committed
691
692
  // Work input until "buf" reaches 32 byte alignment
  while ( ((unsigned long)buf) % 32 != 0 && nframes > 0) {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
693

Uwe Schulzweida's avatar
Uwe Schulzweida committed
694
695
696
697
698
699
700
    // Load the next double into the work buffer
    work = _mm256_set1_pd(*buf);
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf++;
    nframes--;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
701

Uwe Schulzweida's avatar
Uwe Schulzweida committed
702
  while (nframes >= 16) {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
703

Uwe Schulzweida's avatar
Uwe Schulzweida committed
704
705
706
    (void) _mm_prefetch(buf+8, _MM_HINT_NTA);

    work = _mm256_load_pd(buf);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
707
708
709
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf += 4;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
710
711

    work = _mm256_load_pd(buf);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
712
713
714
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf += 4;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
715
716
717
718

    (void) _mm_prefetch(buf+8, _MM_HINT_NTA);

    work = _mm256_load_pd(buf);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
719
720
721
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf += 4;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
722
723

    work = _mm256_load_pd(buf);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
724
725
726
727
728
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf += 4;
    nframes -= 16;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
729

Uwe Schulzweida's avatar
Uwe Schulzweida committed
730
731
732
733
734
735
736
737
  // work through aligned buffers
  while (nframes >= 4) {
    work = _mm256_load_pd(buf);
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf += 4;
    nframes -= 4;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
738

Uwe Schulzweida's avatar
Uwe Schulzweida committed
739
740
741
742
743
744
745
746
  // work through the remainung values
  while ( nframes > 0) {
    work = _mm256_set1_pd(*buf);
    current_min = _mm256_min_pd(current_min, work);
    current_max = _mm256_max_pd(current_max, work);
    buf++;
    nframes--;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
747

Uwe Schulzweida's avatar
Uwe Schulzweida committed
748
  // find min & max value through shuffle tricks
Uwe Schulzweida's avatar
Uwe Schulzweida committed
749

Uwe Schulzweida's avatar
Uwe Schulzweida committed
750
  work = current_min;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
751
  work = _mm256_shuffle_pd(work, work, 5);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
752
753
  work = _mm256_min_pd (work, current_min);
  current_min = work;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
754
  work = _mm256_permute2f128_pd(work, work, 1);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
755
  work = _mm256_min_pd (work, current_min);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
756
757
  _mm256_storeu_pd(fmin, work);

Uwe Schulzweida's avatar
Uwe Schulzweida committed
758
  work = current_max;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
759
760
  work = current_max;
  work = _mm256_shuffle_pd(work, work, 5);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
761
762
  work = _mm256_max_pd (work, current_max);
  current_max = work;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
763
  work = _mm256_permute2f128_pd(work, work, 1);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
764
  work = _mm256_max_pd (work, current_max);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
765
766
767
768
  _mm256_storeu_pd(fmax, work);

  *min = fmin[0];
  *max = fmax[0];
Uwe Schulzweida's avatar
Uwe Schulzweida committed
769

Uwe Schulzweida's avatar
Uwe Schulzweida committed
770
771
  return;
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
772

Uwe Schulzweida's avatar
Uwe Schulzweida committed
773
#elif defined __SSE2__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
774

Uwe Schulzweida's avatar
Uwe Schulzweida committed
775
static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
776
void sse2_minmax_val(const double *restrict buf, size_t nframes, double *min, double *max)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
{
  __m128d current_max, current_min, work;
  
  // load starting max and min values into all slots of the XMM registers
  current_min = _mm_set1_pd(*min);
  current_max = _mm_set1_pd(*max);
  
  // work on input until buf reaches 16 byte alignment
  while ( ((unsigned long)buf) % 16 != 0 && nframes > 0) {
    
    // load one double and replicate
    work = _mm_set1_pd(*buf);    
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);    
    buf++;
    nframes--;
  }
  
  while (nframes >= 8) {
    // use 64 byte prefetch for double octetts
Uwe Schulzweida's avatar
Uwe Schulzweida committed
797
    // __builtin_prefetch(buf+64,0,0); // for GCC 4.3.2 +
Uwe Schulzweida's avatar
Uwe Schulzweida committed
798

Uwe Schulzweida's avatar
Uwe Schulzweida committed
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
    work = _mm_load_pd(buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf += 2;
    work = _mm_load_pd(buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf += 2;
    work = _mm_load_pd(buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf += 2;
    work = _mm_load_pd(buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf += 2;
    nframes -= 8;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
817

Uwe Schulzweida's avatar
Uwe Schulzweida committed
818
819
820
821
822
823
824
825
  // work through smaller chunks of aligned buffers without prefetching
  while (nframes >= 2) {
    work = _mm_load_pd(buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf += 2;
    nframes -= 2;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
826

Uwe Schulzweida's avatar
Uwe Schulzweida committed
827
828
829
830
831
832
833
834
835
  // work through the remaining value
  while ( nframes > 0) {
    // load the last double and replicate
    work = _mm_set1_pd(*buf);
    current_min = _mm_min_pd(current_min, work);
    current_max = _mm_max_pd(current_max, work);
    buf++;
    nframes--;
  }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
836

Uwe Schulzweida's avatar
Uwe Schulzweida committed
837
838
839
840
841
842
843
844
845
  // find final min and max value through shuffle tricks
  work = current_min;
  work = _mm_shuffle_pd(work, work, _MM_SHUFFLE2(0, 1));
  work = _mm_min_pd (work, current_min);
  _mm_store_sd(min, work);
  work = current_max;
  work = _mm_shuffle_pd(work, work, _MM_SHUFFLE2(0, 1));
  work = _mm_max_pd (work, current_max);
  _mm_store_sd(max, work);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
846

Uwe Schulzweida's avatar
Uwe Schulzweida committed
847
848
  return;
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
849

Uwe Schulzweida's avatar
Uwe Schulzweida committed
850
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
851

Uwe Schulzweida's avatar
Uwe Schulzweida committed
852
static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
853
void minmax_val(const double *restrict data, long idatasize, double *fmin, double *fmax)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
854
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
855
#if defined _GET_X86_COUNTER || defined _GET_MACH_COUNTER 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
856
857
  uint64_t start_minmax, end_minmax;
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
858
  size_t datasize = idatasize;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
859

Uwe Schulzweida's avatar
Uwe Schulzweida committed
860
  if ( idatasize < 1 ) return;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
861

Uwe Schulzweida's avatar
Uwe Schulzweida committed
862
863
864
#ifdef _GET_X86_COUNTER 
  start_minmax = _rdtsc();
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
865
866
867
#ifdef _GET_MACH_COUNTER 
  start_minmax = mach_absolute_time();
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
868

Uwe Schulzweida's avatar
Uwe Schulzweida committed
869
#if defined __AVX__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
870

Uwe Schulzweida's avatar
Uwe Schulzweida committed
871
  avx_minmax_val(data, datasize, fmin, fmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
872

Uwe Schulzweida's avatar
Uwe Schulzweida committed
873
#elif defined __SSE2__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
874

Uwe Schulzweida's avatar
Uwe Schulzweida committed
875
  sse2_minmax_val(data, datasize, fmin, fmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
876

Uwe Schulzweida's avatar
Uwe Schulzweida committed
877
#else
Uwe Schulzweida's avatar
Uwe Schulzweida committed
878

Uwe Schulzweida's avatar
Uwe Schulzweida committed
879
880
#ifdef _ARCH_PWR6
#define __UNROLL_DEPTH_1 6
Uwe Schulzweida's avatar
Uwe Schulzweida committed
881

Uwe Schulzweida's avatar
Uwe Schulzweida committed
882
  // to allow pipelining we have to unroll 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
883

Uwe Schulzweida's avatar
Uwe Schulzweida committed
884
885
886
887
#ifdef _GET_IBM_COUNTER 
  hpmStart(1, "minmax fsel");
#endif
  {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
888
889
890
    size_t i, j;
    size_t residual =  datasize % __UNROLL_DEPTH_1;
    size_t ofs = datasize - residual;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
891
892
    double register dmin[__UNROLL_DEPTH_1];
    double register dmax[__UNROLL_DEPTH_1];
Uwe Schulzweida's avatar
Uwe Schulzweida committed
893

Uwe Schulzweida's avatar
Uwe Schulzweida committed
894
895
896
897
898
899
900
901
902
903
904
905
906
907
    for ( j = 0; j < __UNROLL_DEPTH_1; j++) 
      {
	dmin[j] = data[0];
	dmax[j] = data[0];
      }
    
    for ( i = 0; i < datasize - residual; i += __UNROLL_DEPTH_1 ) 
      {
	for (j = 0; j < __UNROLL_DEPTH_1; j++) 
	  {
	    dmin[j] = __fsel(dmin[j] - data[i+j], data[i+j], dmin[j]);
	    dmax[j] = __fsel(data[i+j] - dmax[j], data[i+j], dmax[j]);
	  }
      }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
908

Uwe Schulzweida's avatar
Uwe Schulzweida committed
909
910
911
912
913
    for (j = 0; j < residual; j++) 
      {
	dmin[j] = __fsel(dmin[j] - data[ofs+j], data[ofs+j], dmin[j]);
	dmax[j] = __fsel(data[ofs+j] - dmax[j], data[ofs+j], dmax[j]);
      }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
914

Uwe Schulzweida's avatar
Uwe Schulzweida committed
915
916
917
918
919
920
921
922
923
    for ( j = 0; j < __UNROLL_DEPTH_1; j++) 
      {
	*fmin = __fsel(*fmin - dmin[j], dmin[j], *fmin);
	*fmax = __fsel(dmax[j] - *fmax, dmax[j], *fmax);
      }
  }
#ifdef _GET_IBM_COUNTER 
  hpmStop(1);
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
924

Uwe Schulzweida's avatar
Uwe Schulzweida committed
925
#undef __UNROLL_DEPTH_1
Uwe Schulzweida's avatar
Uwe Schulzweida committed
926
927

#else // original loop
Uwe Schulzweida's avatar
Uwe Schulzweida committed
928

Uwe Schulzweida's avatar
Uwe Schulzweida committed
929
930
931
932
#ifdef _GET_IBM_COUNTER 
  hpmStart(1, "minmax base");
#endif
  {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
933
    size_t i;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
934

Uwe Schulzweida's avatar
Uwe Schulzweida committed
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
#if   defined (CRAY)
#pragma _CRI ivdep
#elif defined (SX)
#pragma vdir nodep
#elif defined (__uxp__)
#pragma loop novrec
#endif
    for ( i = 0; i < datasize; ++i )
      {
	if ( *fmin > data[i] ) *fmin = data[i];
	if ( *fmax < data[i] ) *fmax = data[i];
	/*
	 *fmin = *fmin < data[i] ? *fmin : data[i];
	 *fmax = *fmax > data[i] ? *fmax : data[i];
	 */
      }
  }
#ifdef _GET_IBM_COUNTER 
  hpmStop(1);
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
955

Uwe Schulzweida's avatar
Uwe Schulzweida committed
956
#endif // _ARCH_PWR6 && original loop
Uwe Schulzweida's avatar
Uwe Schulzweida committed
957
#endif // SIMD
Uwe Schulzweida's avatar
Uwe Schulzweida committed
958

Uwe Schulzweida's avatar
Uwe Schulzweida committed
959
#if defined _GET_X86_COUNTER || defined _GET_MACH_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
960
961
#ifdef _GET_X86_COUNTER 
  end_minmax = _rdtsc();
Uwe Schulzweida's avatar
Uwe Schulzweida committed
962
963
964
965
966
967
#endif
#ifdef _GET_MACH_COUNTER 
  end_minmax = mach_absolute_time();
#endif
#if defined __AVX__
  printf("AVX minmax cycles:: %" PRIu64 "\n", 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
968
	 end_minmax-start_minmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
969
  fprintf (stderr, "AVX min: %lf max: %lf\n", *fmin, *fmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
970
971
#elif defined __SSE2__
  printf("SSE2 minmax cycles:: %" PRIu64 "\n", 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
972
	 end_minmax-start_minmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
973
  fprintf (stderr, "SSE2 min: %lf max: %lf\n", *fmin, *fmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
974
#else
Uwe Schulzweida's avatar
Uwe Schulzweida committed
975
  printf("loop minmax cycles:: %" PRIu64 "\n", 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
976
	 end_minmax-start_minmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
977
  fprintf (stderr, "loop min: %lf max: %lf\n", *fmin, *fmax);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
978
979
#endif
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
980

Uwe Schulzweida's avatar
Uwe Schulzweida committed
981
982
  return;
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
983
984
//#undef _GET_X86_COUNTER
//#undef _GET_MACH_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
985
//#undef _GET_IBM_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
986
987
//#undef _ARCH_PWR6

Uwe Schulzweida's avatar
Uwe Schulzweida committed
988
#include <stdint.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
989

Uwe Schulzweida's avatar
Uwe Schulzweida committed
990
991
#if   defined(__GNUC__) && (__GNUC__ >= 4)
#elif defined(__ICC)    && (__ICC >= 1100)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
992
#elif defined(__clang__)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
993
994
995
996
#else
#define DISABLE_SIMD
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
997
#if defined _GET_IBM_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
998
#include <libhpc.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
999
#elif defined _GET_X86_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1000
#include <x86intrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1001
#elif defined _GET_MACH_COUNTER
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1002
#include <mach/mach_time.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1003
1004
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1005
//#define DISABLE_SIMD
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1006

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1007
#ifdef DISABLE_SIMD
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1008
1009
1010
#ifndef ENABLE_AVX
#undef __AVX__
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1011
1012
1013
1014
1015
#ifndef ENABLE_SSE4_1
#undef __SSE4_1__
#endif
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1016
#if defined __AVX__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1017
#include <immintrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1018
#elif defined __SSE4_1__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1019
#include <smmintrin.h>
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1020
1021
1022
1023
1024
#endif

#if defined __AVX__

static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1025
void avx_encode_double_array_2byte(size_t datasize, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1026
1027
				   unsigned char * restrict lGrib,
				   const double * restrict data, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1028
				   double zref, double factor, size_t *gz) 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1029
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1030
  size_t i, j;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1031
  const double *dval = data;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1032
  __m128i *sgrib = (__m128i *) (lGrib+(*gz));
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105

  const __m128i swap = _mm_set_epi8(14, 15, 12, 13, 10, 11, 8, 9, 6, 7, 4, 5, 2, 3, 0, 1);

  const __m256d c0 = _mm256_set1_pd(zref);
  const __m256d c1 = _mm256_set1_pd(factor);
  const __m256d c2 = _mm256_set1_pd(0.5);
  
  __m256d d0, d3, d2, d1;
  __m128i i0, i1, i2, i3;
  __m128i s0, s1;  

  for (i = 0; i < datasize; i += 16)
    {
      (void) _mm_prefetch(dval+8, _MM_HINT_NTA);
      //_____________________________________________________________________________

      d0 = _mm256_loadu_pd (dval);
      d0 = _mm256_sub_pd (d0, c0);
      d0 = _mm256_mul_pd (d0, c1);
      d0 = _mm256_add_pd (d0, c2);

      i0 = _mm256_cvttpd_epi32 (d0);
      
      //_____________________________________________________________________________
      
      d1 = _mm256_loadu_pd (dval+4);
      d1 = _mm256_sub_pd (d1, c0);
      d1 = _mm256_mul_pd (d1, c1);
      d1 = _mm256_add_pd (d1, c2);
      
      i1 = _mm256_cvttpd_epi32 (d1);

      //_____________________________________________________________________________

      s0 = _mm_packus_epi32(i0, i1);
      s0 = _mm_shuffle_epi8 (s0, swap);
      (void) _mm_storeu_si128 (sgrib, s0);

      //_____________________________________________________________________________

      (void) _mm_prefetch(dval+16, _MM_HINT_NTA);

      //_____________________________________________________________________________
      
      d2 = _mm256_loadu_pd (dval+8);
      d2 = _mm256_sub_pd (d2, c0);
      d2 = _mm256_mul_pd (d2, c1);
      d2 = _mm256_add_pd (d2, c2);
      
      i2 = _mm256_cvttpd_epi32 (d2);

      //_____________________________________________________________________________
      
      d3 = _mm256_loadu_pd (dval+12);
      d3 = _mm256_sub_pd (d3, c0);
      d3 = _mm256_mul_pd (d3, c1);
      d3 = _mm256_add_pd (d3, c2);
      
      i3 = _mm256_cvttpd_epi32 (d3);

      //_____________________________________________________________________________

      s1 = _mm_packus_epi32(i2, i3);
      s1 = _mm_shuffle_epi8 (s1, swap);
      (void) _mm_storeu_si128 (sgrib+1, s1);

      //_____________________________________________________________________________
           
      dval += 16;
      sgrib += 2;
    }

  if (i != datasize)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
    {
      uint16_t ui16;
      i -= 16;
      for ( j = i; j < datasize; j++ )
	{
	  ui16 = (uint16_t) ((data[j] - zref) * factor + 0.5);
	  lGrib[*gz+2*j  ] = ui16 >>  8;
	  lGrib[*gz+2*j+1] = ui16;
	}
    }
  
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1117
1118
1119
1120
1121
1122
  *gz += 2*datasize;

  return;
}

#elif defined __SSE4_1__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1123
1124

static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1125
void sse41_encode_double_array_2byte(size_t datasize, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1126
1127
				     unsigned char * restrict lGrib,
				     const double * restrict data, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1128
				     double zref, double factor, size_t *gz) 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1129
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1130
  size_t i, j;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1131
  const double *dval = data;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1132
  __m128i *sgrib = (__m128i *) (lGrib+(*gz));
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148

  const __m128i swap = _mm_set_epi8(14, 15, 12, 13, 10, 11, 8, 9, 6, 7, 4, 5, 2, 3, 0, 1);

  const __m128d c0 = _mm_set1_pd(zref);
  const __m128d c1 = _mm_set1_pd(factor);
  const __m128d c2 = _mm_set1_pd(0.5);
  
  __m128d d0, d4, d3, d2, d1;
  __m128i i0, i1, i2, i3, i4;
  __m128i s0, s1;  

  for (i = 0; i < datasize; i += 16)
    {
      (void) _mm_prefetch(dval+8, _MM_HINT_NTA);
      //_____________________________________________________________________________

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1149
      d0 = _mm_loadu_pd (dval);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1150
1151
1152
1153
      d0 = _mm_sub_pd (d0, c0);
      d0 = _mm_mul_pd (d0, c1);
      d0 = _mm_add_pd (d0, c2);
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1154
      d4 = _mm_loadu_pd (dval+2);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1155
1156
1157
1158
1159
1160
1161
      d4 = _mm_sub_pd (d4, c0);
      d4 = _mm_mul_pd (d4, c1);
      d4 = _mm_add_pd (d4, c2);

      i0 = _mm_cvttpd_epi32 (d0);
      i4 = _mm_cvttpd_epi32 (d4);  
      i0 = _mm_unpacklo_epi64 (i0, i4);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1162

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1163
1164
      //_____________________________________________________________________________
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1165
      d1 = _mm_loadu_pd (dval+4);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1166
1167
1168
1169
      d1 = _mm_sub_pd (d1, c0);
      d1 = _mm_mul_pd (d1, c1);
      d1 = _mm_add_pd (d1, c2);
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1170
      d4 = _mm_loadu_pd (dval+6);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1171
1172
1173
1174
1175
      d4 = _mm_sub_pd (d4, c0);
      d4 = _mm_mul_pd (d4, c1);
      d4 = _mm_add_pd (d4, c2);
      
      i1 = _mm_cvttpd_epi32 (d1);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1176
      i4 = _mm_cvttpd_epi32 (d4);  
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1177
1178
1179
1180
1181
1182
      i1 = _mm_unpacklo_epi64 (i1, i4);

      //_____________________________________________________________________________

      s0 = _mm_packus_epi32(i0, i1);
      s0 = _mm_shuffle_epi8 (s0, swap);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1183
      (void) _mm_storeu_si128 (sgrib, s0);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1184
1185
1186
1187
1188
1189
1190

      //_____________________________________________________________________________

      (void) _mm_prefetch(dval+16, _MM_HINT_NTA);

      //_____________________________________________________________________________
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1191
      d2 = _mm_loadu_pd (dval+8);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1192
1193
1194
1195
      d2 = _mm_sub_pd (d2, c0);
      d2 = _mm_mul_pd (d2, c1);
      d2 = _mm_add_pd (d2, c2);
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1196
      d4 = _mm_loadu_pd (dval+10);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1197
1198
1199
1200
1201
1202
1203
      d4 = _mm_sub_pd (d4, c0);
      d4 = _mm_mul_pd (d4, c1);
      d4 = _mm_add_pd (d4, c2);
      
      i2 = _mm_cvttpd_epi32 (d2);
      i4  = _mm_cvttpd_epi32 (d4);  
      i2 = _mm_unpacklo_epi64 (i2, i4);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1204

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1205
1206
      //_____________________________________________________________________________
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1207
      d3 = _mm_loadu_pd (dval+12);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1208
1209
1210
1211
      d3 = _mm_sub_pd (d3, c0);
      d3 = _mm_mul_pd (d3, c1);
      d3 = _mm_add_pd (d3, c2);
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1212
      d4 = _mm_loadu_pd (dval+14);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
      d4 = _mm_sub_pd (d4, c0);
      d4 = _mm_mul_pd (d4, c1);
      d4 = _mm_add_pd (d4, c2);
      
      i3 = _mm_cvttpd_epi32 (d3);
      i4 = _mm_cvttpd_epi32 (d4);  
      i3 = _mm_unpacklo_epi64 (i3, i4);

      //_____________________________________________________________________________

      s1 = _mm_packus_epi32(i2, i3);
      s1 = _mm_shuffle_epi8 (s1, swap);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1225
      (void) _mm_storeu_si128 (sgrib+1, s1);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1226
1227
1228
1229
1230
1231
1232

      //_____________________________________________________________________________
           
      dval += 16;
      sgrib += 2;
    }

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
  if (i != datasize) 
    {
      uint16_t ui16;
      i -= 16;  
      for ( j = i; j < datasize; j++ )
	{
	  ui16 = (uint16_t) ((data[j] - zref) * factor + 0.5);
	  lGrib[*gz+2*j  ] = ui16 >>  8;
	  lGrib[*gz+2*j+1] = ui16;
	}
    }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1244
1245
1246

  *gz += 2*datasize;
  
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1247
1248
  return;
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1249

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1250
#endif // SIMD variants
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1251

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1252
static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1253
1254
void encode_double_array_common(int numBits, size_t packStart, size_t datasize, GRIBPACK *lGrib,
				const double *data, double zref, double factor, size_t *gz)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1255
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1256
  size_t i, z = *gz;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1257
1258
1259
1260
1261
1262
  unsigned int ival;
  int cbits, jbits;
  unsigned int c;
  static unsigned int mask[] = {0,1,3,7,15,31,63,127,255};
    
  /* code from gribw routine flist2bitstream */
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1263

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
  cbits = 8;
  c = 0;
  for ( i = packStart; i < datasize; i++ )
    {
      /* note float -> unsigned int .. truncate */
      ival = (unsigned int) ((data[i] - zref) * factor + 0.5);
      /*
	if ( ival > max_nbpv_pow2 ) ival = max_nbpv_pow2;
	if ( ival < 0 ) ival = 0;
      */
      jbits = numBits;
      while ( cbits <= jbits ) 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1276
	{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1277
1278
1279
1280
1281
	  if ( cbits == 8 )
	    {
	      jbits -= 8;
	      lGrib[z++] = (ival >> jbits) & 0xFF;
	    }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1282
	  else
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1283
1284
1285
1286
1287
1288
	    {
	      jbits -= cbits;
	      lGrib[z++] = (c << cbits) + ((ival >> jbits) & mask[cbits]);
	      cbits = 8;
	      c = 0;
	    }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1289
	}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1290
1291
      /* now jbits < cbits */
      if ( jbits )
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1292
	{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1293
1294
	  c = (c << jbits) + (ival & mask[jbits]);
	  cbits -= jbits;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1295
1296
	}
    }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1297
  if ( cbits != 8 ) lGrib[z++] = c << cbits;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1298

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1299
1300
  *gz = z;
}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1301

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1302
static
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1303
void encode_double_array_byte(int numBits, size_t packStart, size_t datasize, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1304
1305
			      GRIBPACK *restrict lGrib,
			      const double *restrict data, 
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1306
			      double zref, double factor, size_t *gz)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1307
{
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1308
1309
1310
1311
1312
#if defined _GET_X86_COUNTER || defined _GET_MACH_COUNTER 
  uint64_t start_minmax, end_minmax;
#endif

  uint32_t ui32;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1313
  size_t i, z = *gz;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1314
  double tmp;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1315

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1316
1317
  data += packStart;
  datasize -= packStart;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1318

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1319
  if      ( numBits ==  8 )
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1320
    {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1321
1322
1323
#ifdef _GET_IBM_COUNTER 
      hpmStart(2, "pack 8 bit base");
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1324

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1325
#if defined (CRAY)
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1326
1327
1328
1329
1330
1331
1332
1333
1334
#pragma _CRI ivdep
#elif defined (SX)
#pragma vdir nodep
#elif defined (__uxp__)
#pragma loop novrec
#endif
      for ( i = 0; i < datasize; i++ )
	{
	  tmp = ((data[i] - zref) * factor + 0.5);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1335
	  lGrib[z  ] = (uint16_t) tmp;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1336
1337
          z++;
	}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1338

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1339
1340
1341
#ifdef _GET_IBM_COUNTER 
      hpmStop(2);
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1342
    }
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1343
  else if ( numBits == 16 )
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1344
    {
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1345
1346
#ifdef _GET_IBM_COUNTER 
      hpmStart(3, "pack 16 bit base");
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1347
1348
1349
1350
#elif defined _GET_X86_COUNTER 
  start_minmax = _rdtsc();
#elif defined _GET_MACH_COUNTER 
  start_minmax = mach_absolute_time();
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1351
#endif
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1352

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1353
1354
1355
1356
1357
#if defined __AVX__

      avx_encode_double_array_2byte(datasize, lGrib, data, zref, factor, &z);

#elif defined __SSE4_1__
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1358
1359
1360
1361
1362

      sse41_encode_double_array_2byte(datasize, lGrib, data, zref, factor, &z);

#else

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1363
1364
      uint16_t ui16;

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1365
1366
1367
1368
1369
1370
1371
1372
1373
1374
#if   defined (CRAY)
#pragma _CRI ivdep
#elif defined (SX)
#pragma vdir nodep
#elif defined (__uxp__)
#pragma loop novrec
#endif
      for ( i = 0; i < datasize; i++ )
      	{
      	  tmp = ((data[i] - zref) * factor + 0.5);
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1375
1376
1377
          ui16 = (uint16_t) tmp;
          lGrib[z  ] = ui16 >>  8;
          lGrib[z+1] = ui16;
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1378
1379
          z += 2;
      	}
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1380
1381
#endif

Uwe Schulzweida's avatar
Uwe Schulzweida committed
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393
1394
1395
1396
1397
1398
1399
#if defined _GET_X86_COUNTER || defined _GET_MACH_COUNTER
#if defined _GET_X86_COUNTER 
      end_minmax = _rdtsc();
#elif defined _GET_MACH_COUNTER 
      end_minmax = mach_absolute_time();
#endif
#if defined __AVX__
      printf("AVX encoding cycles:: %" PRIu64 "\n", 
	     end_minmax-start_minmax);
#elif defined __SSE4_1__
      printf("SSE 4.1 encoding cycles:: %" PRIu64 "\n", 
	     end_minmax-start_minmax);
#else
      printf("loop encoding cycles:: %" PRIu64 "\n", 
	     end_minmax-start_minmax);
#endif  
#endif
      
Uwe Schulzweida's avatar
Uwe Schulzweida committed
1400
1401
1402
#ifdef _GET_IBM_COUNTER 
      hpmStop(3);
#endif