Check for SYS/GL during library init. Reason is that
[AROS.git] / rom / usb / shellapps / PencamTool.c
blob0e7dcabeec34955aec31e1a982c376ae95cd6abf
1 /*
2 *----------------------------------------------------------------------------
3 * Pencam Tool for Poseidon
4 *----------------------------------------------------------------------------
5 * By Chris Hodges <chrisly@platon42.de>
6 */
8 #include "debug.h"
10 #include <proto/dos.h>
11 #include <proto/exec.h>
12 #include <proto/poseidon.h>
13 #include <proto/intuition.h>
14 #include <proto/graphics.h>
15 #include <proto/diskfont.h>
17 #include "PencamTool.h"
18 #include <math.h>
19 #include <stdlib.h>
20 #include <string.h>
22 #define ARGS_TO 0
23 #define ARGS_PICNUM 1
24 #define ARGS_INTERVAL 2
25 #define ARGS_UPTO 3
26 #define ARGS_NOBEEP 4
27 #define ARGS_GAMMA 5
28 #define ARGS_SHARPEN 6
29 #define ARGS_TEXT 7
30 #define ARGS_FONT 8
31 #define ARGS_FONTSIZE 9
32 #define ARGS_UNIT 10
33 #define ARGS_SIZEOF 11
35 const char PencamTool_prgname[] = "PencamTool";
36 static const char *template = "TO/A,PICNUM/N,INTERVAL/N,UPTO/N/K,NOBEEP/S,GAMMA/K,SHARPEN/S,TEXT/K,FONT/K,FONTSIZE/N/K,UNIT/N/K";
37 const char PencamTool_version[] = "$VER: PencamTool 1.7 (12.06.09) by Chris Hodges <chrisly@platon42.de>";
38 static IPTR ArgsArray[ARGS_SIZEOF];
39 static struct RDArgs *ArgsHook = NULL;
41 static UWORD gammaredtab[256];
42 static UWORD gammagreentab[256];
43 static UWORD gammabluetab[256];
45 struct RastPort fontrp;
46 struct RastPort picrp;
47 struct TextAttr avenirta;
48 struct TextFont *avenirfont = NULL;
49 struct BitMap *fontbm = NULL;
50 ULONG tlength, theight;
52 struct Library *ps;
54 AROS_UFP3(void, releasehook,
55 AROS_UFPA(struct Hook *, hook, A0),
56 AROS_UFPA(APTR, pab, A2),
57 AROS_UFPA(struct NepClassPencam *, nch, A1));
59 struct NepClassPencam * SetupPencam(void);
60 struct NepClassPencam * AllocPencam(struct NepClassPencam *nch);
61 void FreePencam(struct NepClassPencam *nch);
63 #define GAMMA 0.450
64 #define ZERO 17.0
66 void CreateGammaTab(void)
68 UWORD i;
69 UWORD red, green, blue;
70 double x,y;
71 double gamma;
72 if(!ArgsArray[ARGS_GAMMA])
74 return;
76 gamma = atof((char *) ArgsArray[ARGS_GAMMA]);
77 gammaredtab[0] = gammagreentab[0] = gammabluetab[0] = 0;
78 for(i=1; i<256; ++i)
80 x = i;
81 x -= ZERO;
82 if(x < 1.0)
84 x = 1.0;
86 y = pow((x/256.0), gamma)*255.0;
87 red = (UWORD) (y*1.08);
88 green = (UWORD) y;
89 blue = (UWORD) (y*0.95);
90 gammaredtab[i] = red < 256 ? red : 255;
91 gammagreentab[i] = green;
92 gammabluetab[i] = blue;
96 AROS_UFH3(void, releasehook,
97 AROS_UFHA(struct Hook *, hook, A0),
98 AROS_UFHA(APTR, pab, A2),
99 AROS_UFHA(struct NepClassPencam *, nch, A1))
101 AROS_USERFUNC_INIT
102 /*psdAddErrorMsg(RETURN_WARN, (STRPTR) prgname,
103 "Pencam killed!");*/
104 Signal(nch->nch_Task, SIGBREAKF_CTRL_C);
105 AROS_USERFUNC_EXIT
108 struct NepClassPencam * SetupPencam(void)
110 struct NepClassPencam *nch;
111 struct PsdDevice *pd = NULL;
112 struct PsdAppBinding *pab;
113 ULONG unit;
115 if(ArgsArray[ARGS_UNIT])
117 unit = *((ULONG *) ArgsArray[ARGS_UNIT]);
118 } else {
119 unit = 0;
125 pd = psdFindDevice(pd,
126 DA_VendorID, 0x0553,
127 DA_ProductID, 0x0202,
128 TAG_END);
129 } while(pd && (unit--));
131 if(!pd)
133 PutStr("No Pencam found!\n");
134 return(NULL);
136 if((nch = psdAllocVec(sizeof(struct NepClassPencam))))
138 nch->nch_Device = pd;
139 nch->nch_ReleaseHook.h_Entry = (APTR) releasehook;
141 pab = psdClaimAppBinding(ABA_Device, pd,
142 ABA_ReleaseHook, &nch->nch_ReleaseHook,
143 ABA_UserData, nch,
144 TAG_END);
145 if(pab)
147 if(AllocPencam(nch))
149 return(nch);
150 } else {
151 PutStr("Couldn't allocate Pencam...\n");
153 psdReleaseAppBinding(pab);
154 } else {
155 PutStr("Couldn't claim binding!\n");
157 psdFreeVec(nch);
159 PutStr("Hohum...\n");
160 } while(FALSE);
161 return(NULL);
164 struct RastPort * SetupText(void)
166 STRPTR text = (STRPTR) ArgsArray[ARGS_TEXT];
167 InitRastPort(&fontrp);
168 if(ArgsArray[ARGS_FONT])
170 avenirta.ta_Name = (STRPTR) ArgsArray[ARGS_FONT];
171 if(ArgsArray[ARGS_FONTSIZE])
173 avenirta.ta_YSize = *((ULONG *) ArgsArray[ARGS_FONTSIZE]);
174 } else {
175 avenirta.ta_YSize = 8;
177 avenirta.ta_Style = 0L;
178 avenirta.ta_Flags = 0L;
179 if(!(avenirfont = OpenDiskFont(&avenirta)))
181 Printf("Couldn't open font!\n");
182 } else {
183 SetFont(&fontrp, avenirfont);
186 tlength = TextLength(&fontrp, text, (ULONG) strlen(text));
187 theight = fontrp.Font->tf_YSize;
188 if(!(fontbm = AllocBitMap(tlength, theight, 1L, BMF_CLEAR, NULL)))
190 Printf("Couldn't allocate font bitmap memory (%ldx%ld)", tlength, theight);
191 return(NULL);
193 fontrp.BitMap = fontbm;
194 //printf("String: %s\nLength: %d\n",(char *)argsarray[ARGS_TEXT], tlength);
195 Move(&fontrp, 0, (LONG) fontrp.Font->tf_Baseline);
196 Text(&fontrp, text, (ULONG) strlen(text));
197 return(&fontrp);
200 void FreeText(void)
202 if(fontbm)
204 FreeBitMap(fontbm);
205 fontbm = NULL;
207 if(avenirfont)
209 CloseFont(avenirfont);
210 avenirfont = NULL;
214 void PasteText(struct PCImageHeader *pcih, UBYTE *output)
216 LONG x, y;
217 LONG tarx, tary;
218 LONG vw = pcih->pcih_ImgWidth;
219 LONG vw3 = vw+vw+vw;
220 UBYTE *op;
221 WORD pix;
222 if(tlength < vw-2)
224 tarx = (vw-tlength) >> 1;
225 } else {
226 tarx = 1;
228 tary = (pcih->pcih_ImgHeight-theight-theight);
229 for(y = 0; y < theight; y++)
231 for(x = 0; (x < tlength) && (x+tarx+2 < vw); x++)
233 pix = ReadPixel(&fontrp, x, y);
234 if(pix)
236 op = &output[((tary+y)*vw+tarx+x)*3];
237 op[-vw3] >>= 1;
238 op[-vw3+1] >>= 1;
239 op[-vw3+2] >>= 1;
240 op[-3] >>= 1;
241 op[-2] >>= 1;
242 op[-1] >>= 1;
243 op[3] >>= 1;
244 op[4] >>= 1;
245 op[5] >>= 1;
246 op[vw3] >>= 1;
247 op[vw3+1] >>= 1;
248 op[vw3+2] >>= 1;
252 for(y = 0; y < theight; y++)
254 for(x = 0; (x < tlength) && (x+tarx+2 < vw); x++)
256 pix = ReadPixel(&fontrp, x, y);
257 if(pix)
259 op = &output[((tary+y)*vw+tarx+x)*3];
260 *op++ = 255;
261 *op++ = 255;
262 *op = 255;
268 struct NepClassPencam * AllocPencam(struct NepClassPencam *nch)
270 struct List *cfglist;
271 struct List *iflist;
272 struct List *altiflist;
273 IPTR ifnum;
274 IPTR altnum;
275 struct List *eplist;
277 nch->nch_Task = FindTask(NULL);
279 psdGetAttrs(PGA_DEVICE, nch->nch_Device,
280 DA_ConfigList, &cfglist,
281 TAG_END);
283 if(!cfglist->lh_Head->ln_Succ)
285 PutStr("No configs?\n");
286 return(NULL);
289 nch->nch_Config = (struct PsdConfig *) cfglist->lh_Head;
291 psdGetAttrs(PGA_CONFIG, nch->nch_Config,
292 CA_InterfaceList, &iflist,
293 TAG_END);
295 if(!iflist->lh_Head->ln_Succ)
297 PutStr("No interfaces?\n");
298 return(NULL);
301 nch->nch_Interface = (struct PsdInterface *) iflist->lh_Head;
302 psdGetAttrs(PGA_INTERFACE, nch->nch_Interface,
303 IFA_InterfaceNum, &ifnum,
304 IFA_AlternateNum, &altnum,
305 IFA_AlternateIfList, &altiflist,
306 IFA_EndpointList, &eplist,
307 TAG_END);
309 if((nch->nch_TaskMsgPort = CreateMsgPort()))
311 if((nch->nch_EP0Pipe = psdAllocPipe(nch->nch_Device, nch->nch_TaskMsgPort, NULL)))
313 if((ifnum == 0) && (altnum == 0))
315 psdSetAltInterface(nch->nch_EP0Pipe, altiflist->lh_Head);
317 psdGetAttrs(PGA_CONFIG, nch->nch_Config,
318 CA_InterfaceList, &iflist,
319 TAG_END);
320 nch->nch_Interface = (struct PsdInterface *) iflist->lh_Head;
321 psdGetAttrs(PGA_INTERFACE, nch->nch_Interface,
322 IFA_InterfaceNum, &ifnum,
323 IFA_AlternateNum, &altnum,
324 IFA_EndpointList, &eplist,
325 TAG_END);
326 if(eplist->lh_Head->ln_Succ)
328 nch->nch_BulkEP = (struct PsdEndpoint *) eplist->lh_Head;
329 psdGetAttrs(PGA_ENDPOINT, nch->nch_BulkEP,
330 EA_MaxPktSize, &nch->nch_BulkPktSize,
331 TAG_END);
332 if((nch->nch_BulkPipe = psdAllocPipe(nch->nch_Device, nch->nch_TaskMsgPort, nch->nch_BulkEP)))
334 psdSetAttrs(PGA_PIPE, nch->nch_BulkPipe,
335 PPA_AllowRuntPackets, TRUE,
336 PPA_NakTimeout, TRUE,
337 PPA_NakTimeoutTime, 5000,
338 TAG_END);
339 return(nch);
340 } else {
341 PutStr("Couldn't allocate bulk pipe.\n");
343 } else {
344 PutStr("No bulk endpoint?\n");
346 psdFreePipe(nch->nch_EP0Pipe);
347 } else {
348 PutStr("Couldn't allocate default pipe\n");
350 DeleteMsgPort(nch->nch_TaskMsgPort);
352 return(NULL);
356 void FreePencam(struct NepClassPencam *nch)
358 APTR pab;
360 psdGetAttrs(PGA_DEVICE, nch->nch_Device,
361 DA_Binding, &pab,
362 TAG_END);
363 psdReleaseAppBinding(pab);
364 psdFreePipe(nch->nch_BulkPipe);
365 psdFreePipe(nch->nch_EP0Pipe);
366 DeleteMsgPort(nch->nch_TaskMsgPort);
367 psdFreeVec(nch);
370 /**************************************************************************/
372 void bayer_unshuffle(struct PCImageHeader *pcih, UBYTE *raw, UBYTE *output)
374 ULONG x, y;
375 ULONG w = pcih->pcih_ImgWidth>>1;
376 ULONG vw = pcih->pcih_ImgWidth;
377 ULONG vh = pcih->pcih_ImgHeight;
378 UBYTE *raweven;
379 UBYTE *rawodd;
380 UBYTE *oline;
382 for(y = 0; y < vh; y++)
384 rawodd = &raw[y*vw];
385 raweven = &rawodd[w];
386 oline = output;
387 if(y & 1)
389 ++oline;
391 ++oline;
392 x = w;
395 *oline = *raweven++;
396 oline += 2;
397 *oline = *rawodd++;
398 oline += 4;
399 } while(--x);
400 output += vw;
401 output += vw;
402 output += vw;
406 void bayer_demosaic(struct PCImageHeader *pcih, UBYTE *output)
408 LONG x, y;
409 LONG vw = pcih->pcih_ImgWidth;
410 LONG vw3 = vw+vw+vw;
411 LONG vh = pcih->pcih_ImgHeight;
412 UBYTE *op;
413 for(y = 1; y < vh-1; y++)
415 op = &output[(y*vw + 1)*3];
416 for(x = 1; x < vw-1; x++) /* work out pixel type */
418 switch(((y + y) & 2) + (x & 1))
420 case 0: /* green. red lr, blue tb */
421 *op = (((UWORD) op[-3]) + ((UWORD) op[3])) >> 1; /* Set red */
422 op[2] = (((UWORD) op[2-vw3]) + ((UWORD) op[2+vw3]) + 1) >> 1; /* Set blue */
423 break;
424 case 1: /* red. green lrtb, blue diagonals */
425 op[1] = (((UWORD) op[-2]) + ((UWORD) op[4]) +
426 ((UWORD) op[1-vw3]) + ((UWORD) op[1+vw3]) + 2) >> 2; /* Set green */
427 op[2] = (((UWORD) op[-1-vw3]) + ((UWORD) op[5-vw3]) +
428 ((UWORD) op[-1+vw3]) + ((UWORD) op[5+vw3]) + 2) >> 2; /* Set blue */
429 break;
430 case 2: /* blue. green lrtb, red diagonals */
431 op[1] = (((UWORD) op[-2]) + ((UWORD) op[4]) +
432 ((UWORD) op[1-vw3]) + ((UWORD) op[1+vw3]) + 2) >> 2; /* Set green */
433 *op = (((UWORD) op[-3-vw3]) + ((UWORD) op[3-vw3]) +
434 ((UWORD) op[-3+vw3]) + ((UWORD) op[3+vw3]) + 2) >> 2; /* Set red */
435 break;
436 case 3: /* green. blue lr, red tb */
437 op[2] = (((UWORD) op[-1]) + ((UWORD) op[5]) + 1) >> 1; /* Set blue */
438 *op = (((UWORD) op[-vw3]) + ((UWORD) op[vw3]) + 1) >> 1; /* Set red */
439 break;
440 } /* switch */
441 op += 3;
442 } /* for x */
443 } /* for y */
446 void gammacorrection(struct PCImageHeader *pcih, UBYTE *output)
448 ULONG cnt = pcih->pcih_ImgWidth*pcih->pcih_ImgHeight;
449 while(cnt--)
451 *output = gammaredtab[*output];
452 output++;
453 *output = gammagreentab[*output];
454 output++;
455 *output = gammabluetab[*output];
456 output++;
460 void sharpen5x5(struct PCImageHeader *pcih, UBYTE *input, UBYTE *output)
462 LONG x, y;
463 LONG vw = pcih->pcih_ImgWidth;
464 LONG vw3 = vw+vw+vw;
465 LONG vw6 = vw*6;
466 LONG vh = pcih->pcih_ImgHeight;
467 LONG linem2[3];
468 LONG linem1[3];
469 LONG linep1[3];
470 LONG linep2[3];
471 LONG val[3];
473 UBYTE *op;
474 UBYTE *oop;
475 for(y = 2; y < vh-2; y++)
477 op = &input[((y-2)*vw)*3];
478 linem2[0] = *op++; // -2
479 linem2[1] = *op++;
480 linem2[2] = *op++;
481 linem2[0] += *op++; // -1
482 linem2[1] += *op++;
483 linem2[2] += *op++;
484 linem2[0] += *op++; // 0
485 linem2[1] += *op++;
486 linem2[2] += *op++;
487 linem2[0] += *op++; // 1
488 linem2[1] += *op++;
489 linem2[2] += *op++;
490 linem2[0] += *op++; // 2
491 linem2[1] += *op++;
492 linem2[2] += *op;
494 op = &input[((y-1)*vw+1)*3];
495 linem1[0] = *op++; // -1
496 linem1[1] = *op++;
497 linem1[2] = *op++;
498 linem1[0] += *op++; // 0
499 linem1[1] += *op++;
500 linem1[2] += *op++;
501 linem1[0] += *op++; // 1
502 linem1[1] += *op++;
503 linem1[2] += *op++;
504 linem1[0] += linem1[0]+linem1[0];
505 linem1[1] += linem1[1]+linem1[1];
506 linem1[2] += linem1[2]+linem1[2];
507 linem1[0] += *op++; // 2
508 linem1[1] += *op++;
509 linem1[2] += *op++;
510 linem1[0] += op[-15]; // -2
511 linem1[1] += op[-14];
512 linem1[2] += op[-13];
514 op = &input[((y+1)*vw+1)*3];
515 linep1[0] = *op++; // -1
516 linep1[1] = *op++;
517 linep1[2] = *op++;
518 linep1[0] += *op++; // 0
519 linep1[1] += *op++;
520 linep1[2] += *op++;
521 linep1[0] += *op++; // 1
522 linep1[1] += *op++;
523 linep1[2] += *op++;
524 linep1[0] += linep1[0]+linep1[0];
525 linep1[1] += linep1[1]+linep1[1];
526 linep1[2] += linep1[2]+linep1[2];
527 linep1[0] += *op++; // 2
528 linep1[1] += *op++;
529 linep1[2] += *op++;
530 linep1[0] += op[-15]; // -2
531 linep1[1] += op[-14];
532 linep1[2] += op[-13];
534 op = &input[((y+2)*vw)*3];
535 linep2[0] = *op++; // -2
536 linep2[1] = *op++;
537 linep2[2] = *op++;
538 linep2[0] += *op++; // -1
539 linep2[1] += *op++;
540 linep2[2] += *op++;
541 linep2[0] += *op++; // 0
542 linep2[1] += *op++;
543 linep2[2] += *op++;
544 linep2[0] += *op++; // 1
545 linep2[1] += *op++;
546 linep2[2] += *op++;
547 linep2[0] += *op++; // 2
548 linep2[1] += *op++;
549 linep2[2] += *op;
551 op = &input[(y*vw + 2)*3];
552 oop = &output[(y*vw + 2)*3];
553 for(x = 2; x < vw-2; x++) /* work out pixel type */
555 /* Central line */
556 val[0] = op[-3] + op[3];
557 val[1] = op[-2] + op[4];
558 val[2] = op[-1] + op[5];
559 val[0] += val[0] + val[0] + op[-6] + op[6] + linem2[0] + linem1[0] + linep1[0] + linep2[0];
560 val[1] += val[1] + val[1] + op[-5] + op[7] + linem2[1] + linem1[1] + linep1[1] + linep2[1];
561 val[2] += val[2] + val[2] + op[-4] + op[8] + linem2[2] + linem1[2] + linep1[2] + linep2[2];
562 val[0] -= op[0] * 56;
563 val[1] -= op[1] * 56;
564 val[2] -= op[2] * 56;
565 #define MAXVAL 4080
567 *oop++ = (val[0] > 0) ? 0 : ((val[0] < -MAXVAL) ? 255 : (-val[0]+8)>>4);
568 *oop++ = (val[1] > 0) ? 0 : ((val[1] < -MAXVAL) ? 255 : (-val[1]+8)>>4);
569 *oop++ = (val[2] > 0) ? 0 : ((val[2] < -MAXVAL) ? 255 : (-val[2]+8)>>4);
571 /* Update line y-2 */
572 linem2[0] -= op[-vw6-6];
573 linem2[0] += op[-vw6+9];
574 linem2[1] -= op[-vw6-5];
575 linem2[1] += op[-vw6+10];
576 linem2[2] -= op[-vw6-4];
577 linem2[2] += op[-vw6+11];
579 /* Update line y-1 */
580 linem1[0] -= op[-vw3-6];
581 linem1[0] -= op[-vw3-3]<<1;
582 linem1[0] += op[-vw3+6]<<1;
583 linem1[0] += op[-vw3+9];
584 linem1[1] -= op[-vw3-5];
585 linem1[1] -= op[-vw3-2]<<1;
586 linem1[1] += op[-vw3+7]<<1;
587 linem1[1] += op[-vw3+10];
588 linem1[2] -= op[-vw3-4];
589 linem1[2] -= op[-vw3-1]<<1;
590 linem1[2] += op[-vw3+8]<<1;
591 linem1[2] += op[-vw3+11];
593 /* Update line y+1 */
594 linep1[0] -= op[vw3-6];
595 linep1[0] -= op[vw3-3]<<1;
596 linep1[0] += op[vw3+6]<<1;
597 linep1[0] += op[vw3+9];
598 linep1[1] -= op[vw3-5];
599 linep1[1] -= op[vw3-2]<<1;
600 linep1[1] += op[vw3+7]<<1;
601 linep1[1] += op[vw3+10];
602 linep1[2] -= op[vw3-4];
603 linep1[2] -= op[vw3-1]<<1;
604 linep1[2] += op[vw3+8]<<1;
605 linep1[2] += op[vw3+11];
607 /* Update line y-2 */
608 linep2[0] -= op[vw6-6];
609 linep2[0] += op[vw6+9];
610 linep2[1] -= op[vw6-5];
611 linep2[1] += op[vw6+10];
612 linep2[2] -= op[vw6-4];
613 linep2[2] += op[vw6+11];
615 op += 3;
620 APTR TransferImage(struct NepClassPencam *nch, struct PCImageHeader *pcih)
622 LONG ioerr;
623 UBYTE *rawbuf;
624 UBYTE *imgbuf;
625 UBYTE *newimgbuf;
627 rawbuf = psdAllocVec(pcih->pcih_ImgSize);
628 if(!rawbuf)
630 Printf("Couldn't allocate %ld bytes of memory.\n", pcih->pcih_ImgSize);
631 return(NULL);
633 /* Workaround for a firmware bug */
634 ioerr = psdDoPipe(nch->nch_BulkPipe, rawbuf, 64);
635 if(!ioerr)
637 if(((ULONG *) rawbuf)[0] == AROS_LONG2BE(0xed15ed15))
639 /* Junk packet at the beginning! */
640 ioerr = psdDoPipe(nch->nch_BulkPipe, rawbuf, pcih->pcih_ImgSize);
641 } else {
642 ioerr = psdDoPipe(nch->nch_BulkPipe, &rawbuf[64], pcih->pcih_ImgSize-64);
645 if(!ioerr)
647 imgbuf = psdAllocVec((ULONG) pcih->pcih_ImgWidth * (ULONG) pcih->pcih_ImgHeight * 3);
648 if(imgbuf)
650 bayer_unshuffle(pcih, rawbuf, imgbuf);
651 psdFreeVec(rawbuf);
652 bayer_demosaic(pcih, imgbuf);
653 if(ArgsArray[ARGS_SHARPEN])
655 newimgbuf = psdAllocVec((ULONG) pcih->pcih_ImgWidth * (ULONG) pcih->pcih_ImgHeight * 3);
656 if(newimgbuf)
658 sharpen5x5(pcih, imgbuf, newimgbuf);
659 psdFreeVec(imgbuf);
660 imgbuf = newimgbuf;
663 if(ArgsArray[ARGS_GAMMA])
665 gammacorrection(pcih, imgbuf);
667 if(ArgsArray[ARGS_TEXT])
669 PasteText(pcih, imgbuf);
671 return(imgbuf);
672 } else {
673 Printf("Couldn't allocate %ld bytes of memory.\n", pcih->pcih_ImgSize);
675 } else {
676 Printf("Bulk transfer failed: %s (%ld)\n",
677 psdNumToStr(NTS_IOERR, ioerr, "unknown"), ioerr);
679 psdFreeVec(rawbuf);
680 return(NULL);
683 APTR GetPicture(struct NepClassPencam *nch, ULONG picnum, struct PCImageHeader *pcih)
685 struct PsdPipe *pp;
686 LONG ioerr;
688 pp = nch->nch_EP0Pipe;
689 psdPipeSetup(pp, URTF_IN|URTF_VENDOR|URTF_DEVICE,
690 CMDID_GET_IMAGE_HEADER, picnum, 0);
691 ioerr = psdDoPipe(pp, pcih, sizeof(struct PCImageHeader));
692 if(ioerr)
694 Printf("GET_IMAGE_HEADER failed: %s (%ld)\n",
695 psdNumToStr(NTS_IOERR, ioerr, "unknown"), ioerr);
696 return(NULL);
699 psdPipeSetup(pp, URTF_OUT|URTF_VENDOR|URTF_DEVICE,
700 CMDID_UPLOAD_IMAGE, picnum, 0);
701 ioerr = psdDoPipe(pp, pcih, sizeof(struct PCImageHeader));
702 if(!ioerr)
704 /* endianess conversion */
705 pcih->pcih_ImgSize = AROS_BE2LONG(pcih->pcih_ImgSize);
706 pcih->pcih_ImgWidth = AROS_BE2WORD(pcih->pcih_ImgWidth);
707 pcih->pcih_ImgHeight = AROS_BE2WORD(pcih->pcih_ImgHeight);
708 pcih->pcih_FineExp = AROS_BE2WORD(pcih->pcih_FineExp);
709 pcih->pcih_CoarseExp = AROS_BE2WORD(pcih->pcih_CoarseExp);
711 return(TransferImage(nch, pcih));
712 } else {
713 Printf("UPLOAD_IMAGE failed: %s (%ld)\n",
714 psdNumToStr(NTS_IOERR, ioerr, "unknown"), ioerr);
716 return(NULL);
719 APTR GetVideoSnap(struct NepClassPencam *nch, struct PCImageHeader *pcih)
721 struct PsdPipe *pp;
722 LONG ioerr;
724 pp = nch->nch_EP0Pipe;
725 psdPipeSetup(pp, URTF_IN|URTF_VENDOR|URTF_DEVICE,
726 CMDID_GRAB_UPLOAD, ArgsArray[ARGS_NOBEEP] ? 0x6000L : 0x2000L, 0);
727 ioerr = psdDoPipe(pp, pcih, 8);
728 if(ioerr)
730 Printf("GRAB_UPLOAD failed: %s (%ld)\n",
731 psdNumToStr(NTS_IOERR, ioerr, "unknown"), ioerr);
732 return(NULL);
735 /* endianess conversion */
736 pcih->pcih_ImgSize = AROS_BE2LONG(pcih->pcih_ImgSize);
737 pcih->pcih_ImgWidth = AROS_BE2WORD(pcih->pcih_ImgWidth);
738 pcih->pcih_ImgHeight = AROS_BE2WORD(pcih->pcih_ImgHeight);
739 pcih->pcih_FineExp = AROS_BE2WORD(pcih->pcih_FineExp);
740 pcih->pcih_CoarseExp = AROS_BE2WORD(pcih->pcih_CoarseExp);
742 return(TransferImage(nch, pcih));
745 int main(int argc, char *argv[])
747 struct NepClassPencam *nch;
748 struct PCImageHeader pcih;
749 BPTR outfile;
750 UBYTE *imgbuf;
751 ULONG sigs;
752 char buf[256];
753 ULONG imgcount;
754 ULONG picnum;
756 if(!(ArgsHook = ReadArgs(template, ArgsArray, NULL)))
758 PutStr("Wrong arguments!\n");
759 return(RETURN_FAIL);
761 ps = OpenLibrary("poseidon.library", 1);
762 if(!ps)
764 FreeArgs(ArgsHook);
765 return(RETURN_FAIL);
767 if(ArgsArray[ARGS_TEXT])
769 if(!(SetupText()))
771 FreeArgs(ArgsHook);
772 CloseLibrary(ps);
773 return(RETURN_ERROR);
776 if(!(nch = SetupPencam()))
778 FreeText();
779 FreeArgs(ArgsHook);
780 CloseLibrary(ps);
781 return(RETURN_ERROR);
783 CreateGammaTab();
784 imgcount = 0;
785 if(ArgsArray[ARGS_PICNUM])
787 picnum = *((ULONG *) ArgsArray[ARGS_PICNUM]);
788 } else {
789 picnum = 0;
793 imgbuf = NULL;
794 if(ArgsArray[ARGS_PICNUM])
796 imgbuf = GetPicture(nch, picnum, &pcih);
797 } else {
798 imgbuf = GetVideoSnap(nch, &pcih);
800 if(imgbuf)
802 psdSafeRawDoFmt(buf, 256, (STRPTR) ArgsArray[ARGS_TO], imgcount);
803 outfile = Open(buf, MODE_NEWFILE);
804 if(outfile)
806 UWORD y;
807 ULONG h = pcih.pcih_ImgHeight;
808 ULONG vh = h-4;
809 ULONG w = pcih.pcih_ImgWidth*3;
810 ULONG vw = w-4*3;
811 for(y = 0; y < vh; y++)
813 memcpy(imgbuf+y*vw, imgbuf+(y+2)*w+6, (size_t) vw);
815 FPrintf(outfile, "P6\n%ld %ld\n255\n", vw/3, vh);
816 Flush(outfile);
817 Write(outfile, imgbuf, vw*vh);
818 Close(outfile);
819 Printf("Wrote image into '%s'.\n", buf);
820 imgcount++;
821 } else {
822 Printf("Could not open file '%s' for writing!\n", buf);
824 psdFreeVec(imgbuf);
825 } else {
826 break;
828 sigs = SetSignal(0, 0);
829 if(sigs & SIGBREAKF_CTRL_C)
831 break;
833 if(ArgsArray[ARGS_INTERVAL])
835 if((!ArgsArray[ARGS_PICNUM]) && ArgsArray[ARGS_UPTO])
837 if(imgcount > *((ULONG *) ArgsArray[ARGS_UPTO]))
839 break;
842 Delay(*((ULONG *) ArgsArray[ARGS_INTERVAL]));
843 } else {
844 if(ArgsArray[ARGS_UPTO])
846 if(picnum < *((ULONG *) ArgsArray[ARGS_UPTO]))
848 picnum++;
849 } else {
850 break;
852 } else {
853 break;
856 sigs = SetSignal(0, 0);
857 if(sigs & SIGBREAKF_CTRL_C)
859 break;
861 } while(TRUE);
862 FreeText();
863 FreePencam(nch);
864 FreeArgs(ArgsHook);
865 CloseLibrary(ps);
866 return(RETURN_OK);