287
288
289
290
291#include "implicit_f.inc"
292#include "mvsiz_p.inc"
293
294
295
296
297 INTEGER JFT,JLT,NPLAT,IPLAT(*)
299 . vol(*),thk0(*),thk2(*),a_i(*),z1(*),hm(mvsiz,4),hz(*),
300 . px1(*) ,px2(*) ,py1(*) ,py2(*) ,ph1(*) ,ph2(*) ,
301 . hxx(*),hyy(*),hxy(*),
302 . k11(3,3,*),k12(3,3,*),k13(3,3,*),k14(3,3,*),
303 . k22(3,3,*),k23(3,3,*),k24(3,3,*),k33(3,3,*),
304 . m11(3,3,*),m12(3,3,*),m13(3,3,*),m14(3,3,*),
305 . m22(3,3,*),m23(3,3,*),m24(3,3,*),m33(3,3,*),
306 . mf11(3,3,*),mf12(3,3,*),mf13(3,3,*),mf14(3,3,*),
307 . mf22(3,3,*),mf23(3,3,*),mf24(3,3,*),mf33(3,3,*),
308 . fm12(3,3,*),fm13(3,3,*),fm14(3,3,*),
309 . fm23(3,3,*),fm24(3,3,*),fm34(3,3,*),
310 . k34(3,3,*),k44(3,3,*),m34(3,3,*),m44(3,3,*),
311 . mf34(3,3,*),mf44(3,3,*),dhz(*)
313 . phkrx(4,*),phkry(4,*),
314 . phkrxy(4,*),pherx(4,*),phery(4,*),pherxy(4,*),
315 . phkrz(4,*),pherz(4,*),phkx(*) ,phky(*) ,phex(*) ,phey(*)
316
317
318
319
320
321
322 INTEGER EP,I,J,NF,M
324 . dm(3,3,mvsiz),c1,c2,gm(mvsiz),
325 . g11(mvsiz),g12(mvsiz),g13(mvsiz),
326 . g14(mvsiz),g22(mvsiz),g23(mvsiz),
327 . g24(mvsiz),g33(mvsiz),g34(mvsiz),g44(mvsiz),
328 . chm(2,2,mvsiz),chf(2,2,mvsiz),facf(mvsiz),fac,
329 . gama(4,mvsiz),cxx,cyy,cxy,c11,c22,c12,rz_3,
330 . cbkrx(4,mvsiz),cbkry(4,mvsiz),cbkrz(4,mvsiz),
331 . cberx(4,mvsiz),cbery(4,mvsiz),cberz(4,mvsiz
332 . grz3(4,mvsiz),zr(mvsiz),c3,cx1,cx2,cy1,cy2,zr2
333
334
335#include "vectorize.inc"
336 DO m=jft,jlt
337 ep=iplat(m)
338 c2=vol(ep)
339 c1= third*c2
340 dm(1,1,m)=hm(ep,1)*c1
341 dm(2,2,m)=hm(ep,2)*c1
342 dm(1,2,m)=hm(ep,3)*c1
343
344 dm(1,3,m)=zero
345 dm(2,3,m)=zero
346 dm(3,3,m)=hm(ep,4)*c1
347 zr(m) = z1(ep)
348
349 ENDDO
350 DO m=jft,jlt
351 dm(2,1,m)=dm(1,2,m)
352 dm(3,1,m)=dm(1,3,m)
353 dm(3,2,m)=dm(2,3,m)
354 ENDDO
355
356
357
358 DO ep=jft,jlt
359 chm(1,1,ep)=dhz(ep)*hyy(ep)
360 chm(2,2,ep)=dhz(ep)*hxx(ep)
361 chm(1,2,ep)=-dhz(ep)*hxy(ep)
362 chm(2,1,ep)=chm(1,2,ep)
363 ENDDO
364
365 DO ep=jft,jlt
366 gama(1,ep)=fourth-ph1(ep)
367 gama(2,ep)=-fourth-ph2(ep)
368 gama(3,ep)=fourth+ph1(ep)
369 gama(4,ep)=-fourth+ph2(ep)
370 g11(ep) =gama(1,ep)*gama(1,ep)
371 g12(ep) =gama(1,ep)*gama(2,ep)
372 g13(ep) =gama(1,ep)*gama(3,ep)
373 g14(ep) =gama(1,ep)*gama(4,ep)
374 g22(ep) =gama(2,ep)*gama(2,ep)
375 g23(ep) =gama(2,ep)*gama(3,ep)
376 g24(ep) =gama(2,ep)*gama(4,ep)
377 g33(ep) =gama(3,ep)*gama(3,ep)
378 g34(ep) =gama(3,ep)*gama(4,ep)
379 g44(ep) =gama(4,ep)*gama(4,ep)
380 ENDDO
381
382 DO i=1,2
383 DO j=i,2
384 DO ep=jft,jlt
385 k11(i,j,ep)=k11(i,j,ep)+chm(i,j,ep)*g11(ep)
386 k22(i,j,ep)=k22(i,j,ep)+chm(i,j,ep)*g22(ep)
387 k33(i,j,ep)=k33(i,j,ep)+chm(i,j,ep)*g33(ep)
388 k44(i,j,ep)=k44(i,j,ep)+chm(i,j,ep)*g44(ep)
389 ENDDO
390 ENDDO
391 ENDDO
392 DO i=1,2
393 DO j=1,2
394 DO ep=jft,jlt
395 k12(i,j,ep)=k12(i,j,ep)+chm(i,j,ep)*g12(ep)
396 k13(i,j,ep)=k13(i,j,ep)+chm(i,j,ep)*g13(ep)
397 k14(i,j,ep)=k14(i,j,ep)+chm(i,j,ep)*g14(ep)
398 k23(i,j,ep)=k23(i,j,ep)+chm(i,j,ep)*g23(ep)
399 k24(i,j,ep)=k24(i,j,ep)+chm(i,j,ep)*g24(ep)
400 k34(i,j,ep)=k34(i,j,ep)+chm(i,j,ep)*g34(ep)
401 ENDDO
402 ENDDO
403 ENDDO
404
405 DO j=1,4
406 DO m=jft,jlt
407 rz_3= dhz(m)*third
408 grz3(j,m)=gama(j,m)*rz_3
409 ENDDO
410 ENDDO
411
412 DO m=jft,jlt
413 i=1
414 j=1
415 c1 = -(phky(m)*phkrz(j,m)+phey(m)*pherz(j,m))
416 c2 = (phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m))
417 mf11(1,3,m)=mf11(1,3,m)+grz3(i,m)*c1
418 mf11(2,3,m)=mf11(2,3,m)+grz3(i,m)*c2
419 i=2
420 fm12(3,1,m)=fm12(3,1,m)+ grz3(i,m)*c1
421 fm12(3,2,m)=fm12(3,2,m)+ grz3(i,m)*c2
422 i=3
423 fm13(3,1,m)=fm13(3,1,m)+grz3(i,m)*c1
424 fm13(3,2,m)=fm13(3,2,m)+grz3(i,m)*c2
425 i=4
426 fm14(3,1,m)=fm14(3,1,m)+ grz3(i,m)*c1
427 fm14(3,2,m)=fm14(3,2,m)+ grz3(i,m)*c2
428 j=2
429 c1 = -(phky(m)*phkrz(j,m)+phey(m)*pherz(j,m))
430 c2 = (phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m))
431 i=1
432 mf12(1,3,m)=mf12(1,3,m)+grz3(i,m)*c1
433 mf12(2,3,m)=mf12(2,3,m)+grz3(i,m)*c2
434 i=2
435 mf22(1,3,m)=mf22(1,3,m)+grz3(i,m)*c1
436 mf22(2,3,m)=mf22(2,3,m)+grz3(i,m)*c2
437 i=3
438 fm23(3,1,m)=fm23(3,1,m)+grz3(i,m)*c1
439 fm23(3,2,m)=fm23(3,2,m)+grz3(i,m)*c2
440 i=4
441 fm24(3,1,m)=fm24(3,1,m)+ grz3(i,m)*c1
442 fm24(3,2,m)=fm24(3,2,m)+ grz3(i,m)*c2
443 j=3
444 c1 = -(phky(m)*phkrz(j,m)+phey(m)*pherz(j,m))
445 c2 = (phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m))
446 i=1
447 mf13(1,3,m)=mf13(1,3,m)+ grz3(i,m)*c1
448 mf13(2,3,m)=mf13(2,3,m)+ grz3(i,m)*c2
449 i=2
450 mf23(1,3,m)=mf23(1,3,m)+grz3(i,m)*c1
451 mf23(2,3,m)=mf23(2,3,m)+grz3(i,m)*c2
452 i=3
453 mf33(1,3,m)=mf33(1,3,m)+ grz3(i,m)*c1
454 mf33(2,3,m)=mf33(2,3,m)+ grz3(i,m)*c2
455 i=4
456 fm34(3,1,m)=fm34(3,1,m)+ grz3(i,m)*c1
457 fm34(3,2,m)=fm34(3,2,m)+ grz3(i,m)*c2
458 j=4
459 c1 = -(phky(m)*phkrz(j,m)+phey(m)*pherz(j,m))
460 c2 = (phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m))
461 i=1
462 mf14(1,3,m)=mf14(1,3,m)+ grz3(i,m)*c1
463 mf14(2,3,m)=mf14(2,3,m)+ grz3(i,m)*c2
464 i=2
465 mf24(1,3,m)=mf24(1,3,m)+ grz3(i,m)*c1
466 mf24(2,3,m)=mf24(2,3,m)+ grz3(i,m)*c2
467 i=3
468 mf34(1,3,m)=mf34(1,3,m)+ grz3(i,m)*c1
469 mf34(2,3,m)=mf34(2,3,m)+ grz3(i,m)*c2
470 i=4
471 mf44(1,3,m)=mf44(1,3,m)+ grz3(i,m)*c1
472 mf44(2,3,m)=mf44(2,3,m)+ grz3(i,m)*c2
473 ENDDO
474
475 DO ep=jft,jlt
476 rz_3= dhz(ep)*third
477 i=1
478 j=1
479 m11(3,3,ep)=m11(3,3,ep)+
480 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
481 j=2
482 m12(3,3,ep)=m12(3,3,ep)+
483 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
484 j=3
485 m13(3,3,ep)=m13(3,3,ep)+
486 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
487 j=4
488 m14(3,3,ep)=m14(3,3,ep)+
489 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
490 i=2
491 j=2
492 m22(3,3,ep)=m22(3,3,ep)+
493 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
494 j=3
495 m23(3,3,ep)=m23(3,3,ep)+
496 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
497 j=4
498 m24(3,3,ep)=m24(3,3,ep)+
499 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
500 i=3
501 j=3
502 m33(3,3,ep)=m33(3,3,ep)+
503 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
504 j=4
505 m34(3,3,ep)=m34(3,3,ep)+
506 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
507 i=4
508 m44(3,3,ep)=m44(3,3,ep)+
509 . rz_3*(phkrz(i,ep)*phkrz(j,ep)+pherz(i,ep)*pherz(j,ep))
510 ENDDO
511
512
513
514
515
516 DO j=1,4
517 DO m=jft,jlt
518 cbkrx(j,m) =dm(1,1,m)*phkrx(j,m)+dm(1,2,m)*phkry(j,m)+
519 . dm(1,3,m)*phkrxy(j,m)
520 cbkry(j,m) =dm(2,1,m)*phkrx(j,m)+dm(2,2,m)*phkry(j,m)+
521 . dm(2,3,m)*phkrxy(j,m)
522 cbkrz(j,m) =dm(3,1,m)*phkrx(j,m)+dm(3,2,m)*phkry(j,m)+
523 . dm(3,3,m)*phkrxy(j,m)
524 cberx(j,m) =dm(1,1,m)*pherx(j,m)+dm(1,2,m)*phery(j,m)+
525 . dm(1,3,m)*pherxy(j,m)
526 cbery(j,m) =dm(2,1,m)*pherx(j,m)+dm(2,2,m)*phery(j,m)+
527 . dm(2,3,m)*pherxy(j,m)
528 cberz(j,m) =dm(3,1,m)*pherx(j,m)+dm(3,2,m)*phery(j,m)+
529 . dm(3,3,m)*pherxy(j,m)
530 ENDDO
531 ENDDO
532
533 DO m=jft,jlt
534 i=1
535 j=1
536 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
537 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
538 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
539 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
540 mf11(1,3,m)=mf11(1,3,m)+gama(i,m)*c1
541 mf11(2,3,m)=mf11(2,3,m)+gama(i,m)*c2
542 i=2
543 fm12(3,1,m)=fm12(3,1,m)+ gama(i,m)*c1
544 fm12(3,2,m)=fm12(3,2,m)+ gama(i,m)*c2
545 i=3
546 fm13(3,1,m)=fm13(3,1,m)+gama(i,m)*c1
547 fm13(3,2,m)=fm13(3,2,m)+gama(i,m)*c2
548 i=4
549 fm14(3,1,m)=fm14(3,1,m)+ gama(i,m)*c1
550 fm14(3,2,m)=fm14(3,2,m)+ gama(i,m)*c2
551 j=2
552 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
553 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
554 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
555 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
556 i=1
557 mf12(1,3,m)=mf12(1,3,m)+gama(i,m)*c1
558 mf12(2,3,m)=mf12(2,3,m)+gama(i,m)*c2
559 i=2
560 mf22(1,3,m)=mf22(1,3,m)+gama(i,m)*c1
561 mf22(2,3,m)=mf22(2,3,m)+gama(i,m)*c2
562 i=3
563 fm23(3,1,m)=fm23(3,1,m)+ gama(i,m)*c1
564 fm23(3,2,m)=fm23(3,2,m)+ gama(i,m)*c2
565 i=4
566 fm24(3,1,m)=fm24(3,1,m)+ gama(i,m)*c1
567 fm24(3,2,m)=fm24(3,2,m)+ gama(i,m)*c2
568 j=3
569 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
570 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
571 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
572 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
573 i=1
574 mf13(1,3,m)=mf13(1,3,m)+ gama(i,m)*c1
575 mf13(2,3,m)=mf13(2,3,m)+ gama(i,m)*c2
576 i=2
577 mf23(1,3,m)=mf23(1,3,m)+gama(i,m)*c1
578 mf23(2,3,m)=mf23(2,3,m)+gama(i,m)*c2
579 i=3
580 mf33(1,3,m)=mf33(1,3,m)+ gama(i,m)*c1
581 mf33(2,3,m)=mf33(2,3,m)+ gama(i,m)*c2
582 i=4
583 fm34(3,1,m)=fm34(3,1,m)+ gama(i,m)*c1
584 fm34(3,2,m)=fm34(3,2,m)+ gama(i,m)*c2
585 j=4
586 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
587 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
588 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
589 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
590 i=1
591 mf14(1,3,m)=mf14(1,3,m)+ gama(i,m)*c1
592 mf14(2,3,m)=mf14(2,3,m)+ gama(i,m)*c2
593 i=2
594 mf24(1,3,m)=mf24(1,3,m)+ gama(i,m)*c1
595 mf24(2,3,m)=mf24(2,3,m)+ gama(i,m)*c2
596 i=3
597 mf34(1,3,m)=mf34(1,3,m)+ gama(i,m)*c1
598 mf34(2,3,m)=mf34(2,3,m)+ gama(i,m)*c2
599 i=4
600 mf44(1,3,m)=mf44(1,3,m)+ gama(i,m)*c1
601 mf44(2,3,m)=mf44(2,3,m)+ gama(i,m)*c2
602 ENDDO
603
604 DO m=jft,jlt
605 i=1
606 j=1
607 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
608 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
609 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
610 m11(3,3,m)=m11(3,3,m)+c1
611 j=2
612 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
613 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
614 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
615 m12(3,3,m)=m12(3,3,m)+c1
616 j=3
617 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
618 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
619 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
620 m13(3,3,m)=m13(3,3,m)+c1
621 j=4
622 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
623 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
624 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
625 m14(3,3,m)=m14(3,3,m)+c1
626 i=2
627 j=2
628 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
629 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
630 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
631 m22(3,3,m)=m22(3,3,m)+c1
632 j=3
633 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
634 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
635 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
636 m23(3,3,m)=m23(3,3,m)+c1
637 j=4
638 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
639 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
640 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
641 m24(3,3,m)=m24(3,3,m)+c1
642 i=3
643 j=3
644 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
645 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
646 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
647 m33(3,3,m)=m33(3,3,m)+c1
648 j=4
649 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
650 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
651 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
652 m34(3,3,m)=m34(3,3,m)+c1
653 i=4
654 c1 = phkrx(i,m)*cbkrx(j,m)+pherx(i,m)*cberx(j,m)
655 . +phkry(i,m)*cbkry(j,m)+phery(i,m)*cbery(j,m)
656 . +phkrxy(i,m)*cbkrz(j,m)+pherxy(i,m)*cberz(j,m)
657 m44(3,3,m)=m44(3,3,m)+c1
658 ENDDO
659
660 nf=nplat+1
661 DO m=nf,jlt
662 j=1
663 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
664 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
665 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
666 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
667
668 c3 = zr(m)*(px1(m)*c1+py1(m)*c2)
669 mf11(3,3,m)=mf11(3,3,m)+ c3
670 fm13(3,3,m)=fm13(3,3,m)- c3
671
672 c3 = zr(m)*(px2(m)*c1+py2(m)*c2)
673 fm12(3,3,m)=fm12(3,3,m)+ c3
674 fm14(3,3,m)=fm14(3,3,m)- c3
675 j=2
676 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
677 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
678 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
679 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
680
681 c3 = zr(m)*(px1(m)*c1+py1(m)*c2)
682 mf12(3,3,m)=mf12(3,3,m)+ c3
683 fm23(3,3,m)=fm23(3,3,m)- c3
684
685 c3 = zr(m)*(px2(m)*c1+py2(m)*c2)
686 mf22(3,3,m)=mf22(3,3,m)+ c3
687 fm24(3,3,m)=fm24(3,3,m)- c3
688 j=3
689 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
690 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
691 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
692 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
693
694 c3 = zr(m)*(px1(m)*c1+py1(m)*c2)
695 mf13(3,3,m)=mf13(3,3,m)+ c3
696 mf33(3,3,m)=mf33(3,3,m)- c3
697
698 c3 = zr(m)*(px2(m)*c1+py2(m)*c2)
699 mf23(3,3,m)=mf23(3,3,m)+ c3
700 fm34(3,3,m)=fm34(3,3,m)- c3
701 j=4
702 c1 = (phkx(m)*cbkrx(j,m)+phex(m)*cberx(j,m)+
703 . phky(m)*cbkrz(j,m)+phey(m)*cberz(j,m))
704 c2 = (phky(m)*cbkry(j,m)+phey(m)*cbery(j,m)+
705 . phkx(m)*cbkrz(j,m)+phex(m)*cberz(j,m))
706
707 c3 = zr(m)*(px1(m)*c1+py1(m)*c2)
708 mf14(3,3,m)=mf14(3,3,m)+ c3
709 mf34(3,3,m)=mf34(3,3,m)- c3
710
711 c3 = zr(m)*(px2(m)*c1+py2(m)*c2)
712 mf24(3,3,m)=mf24(3,3,m)+ c3
713 mf44(3,3,m)=mf44(3,3,m)- c3
714 ENDDO
715
716
717
718
719
720 DO m=nf,jlt
721
722 j=1
723
724 c11 = zr(m)*gama(j,m)
725
726 c1 = (chm(1,1,m)*px1(m)+chm(1,2,m)*py1(m))*c11
727 c2 = (chm(1,2,m)*px1(m)+chm(2,2,m)*py1(m))*c11
728 k11(1,3,m)=k11(1,3,m)+ c1
729 k13(1,3,m)=k13(1,3,m)- c1
730 k11(2,3,m)=k11(2,3,m)+ c2
731 k13(2,3,m)=k13(2,3,m)- c2
732
733 c1 = (chm(1,1,m)*px2(m)+chm(1,2,m)*py2(m))*c11
734 c2 = (chm(1,2,m)*px2(m)+chm(2,2,m)*py2(m))*c11
735 k12(1,3,m)=k12(1,3,m)+ c1
736 k14(1,3,m)=k14(1,3,m)- c1
737 k12(2,3,m)=k12(2,3,m)+ c2
738 k14(2,3,m)=k14(2,3,m)- c2
739
740 j=2
741
742 c11 = zr(m)*gama(j,m)
743
744 c1 = (chm(1,1,m)*px1(m)+chm(1,2,m)*py1(m))*c11
745 c2 = (chm(1,2,m)*px1(m)+chm(2,2,m)*py1(m))*c11
746 k12(3,1,m)=k12(3,1,m)+ c1
747 k23(1,3,m)=k23(1,3,m)- c1
748 k12(3,2,m)=k12(3,2,m)+ c2
749 k23(2,3,m)=k23(2,3,m)- c2
750
751 c1 = (chm(1,1,m)*px2(m)+chm(1,2,m)*py2(m))*c11
752 c2 = (chm(1,2,m)*px2(m)+chm(2,2,m)*py2(m))*c11
753 k22(1,3,m)=k22(1,3,m)+ c1
754 k24(1,3,m)=k24(1,3,m)- c1
755 k22(2,3,m)=k22(2,3,m)+ c2
756 k24(2,3,m)=k24(2,3,m)- c2
757
758 j=3
759
760 c11 = zr(m)*gama(j,m)
761
762 c1 = (chm(1,1,m)*px1(m)+chm(1,2,m)*py1(m))*c11
763 c2 = (chm(1,2,m)*px1(m)+chm(2,2,m)*py1(m))*c11
764 k13(3,1,m)=k13(3,1,m)+ c1
765 k33(1,3,m)=k33(1,3,m)- c1
766 k13(3,2,m)=k13(3,2,m)+ c2
767 k33(2,3,m)=k33(2,3,m)- c2
768
769 c1 = (chm(1,1,m)*px2(m)+chm(1,2,m)*py2(m))*c11
770 c2 = (chm(1,2,m)*px2(m)+chm(2,2,m)*py2(m))*c11
771 k23(3,1,m)=k23(3,1,m)+ c1
772 k34(1,3,m)=k34(1,3,m)- c1
773 k23(3,2,m)=k23(3,2,m)+ c2
774 k34(2,3,m)=k34(2,3,m)- c2
775
776 j=4
777
778 c11 = zr(m)*gama(j,m)
779
780 c1 = (chm(1,1,m)*px1(m)+chm(1,2,m)*py1(m))*c11
781 c2 = (chm(1,2,m)*px1(m)+chm(2,2,m)*py1(m))*c11
782 k14(3,1,m)=k14(3,1,m)+ c1
783 k34(3,1,m)=k34(3,1,m)- c1
784 k14(3,2,m)=k14(3,2,m)+ c2
785 k34(3,2,m)=k34(3,2,m)- c2
786
787 c1 = (chm(1,1,m)*px2(m)+chm(1,2,m)*py2(m))*c11
788 c2 = (chm(1,2,m)*px2(m
789 k24(3,1,m)=k24(3,1,m)+ c1
790 k44(1,3,m)=k44(1,3,m)- c1
791 k24(3,2,m)=k24(3,2,m)+ c2
792 k44(2,3,m)=k44(2,3,m)- c2
793 ENDDO
794
795 DO m=nf,jlt
796 zr2= zr(m)*zr(m)
797
798 j=1
799
800 cx1=zr2*(chm(1,1,m)*px1(m)+chm(1,2,m)*py1(m))
801 cy1=zr2*(chm(1,2,m)*px1(m)+chm(2,2,m)*py1(m))
802
803 c3=px1(m)*cx1+py1(m)*cy1
804 k11(3,3,m)=k11(3,3,m)+ c3
805
806 k13(3,3,m)=k13(3,3,m)- c3
807 k33(3,3,m)=k33(3,3,m)+ c3
808
809 c3=px2(m)*cx1+py2(m)*cy1
810
811 k23(3,3,m)=k23(3,3,m)- c3
812
813 j=2
814
815 cx1=zr2*(chm(1,1,m)*px2(m)+chm(1,2,m)*py2(m))
816 cy1=zr2*(chm(1,2,m)*px2(m)+chm(2,2,m)*py2(m))
817
818 c3=px1(m)*cx1+py1(m)*cy1
819 k12(3,3,m)=k12(3,3,m)+ c3
820
821 k14(3,3,m)=k14(3,3,m)- c3
822 k34(3,3,m)=k34(3,3,m)+ c3
823
824 c3=px2(m)*cx1+py2(m)*cy1
825 k22(3,3,m)=k22(3,3,m)+ c3
826
827 k24(3,3,m)=k24(3,3,m)- c3
828 k44(3,3,m)=k44(3,3,m)+ c3
829 ENDDO
830
831 DO m=nf,jlt
832 rz_3= zr(m)*dhz(m)*third
833
834 j=1
835
836 cx2 = phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m)
837 cy2 = phky(m)*phkrz(j,m)+phey(m)*pherz(j,m)
838
839 c3 = rz_3*(-px1(m)*cy2+py1(m)*cx2)
840 mf11(3,3,m)=mf11(3,3,m)+ c3
841 fm13(3,3,m)=fm13(3,3,m)- c3
842
843 c3 = rz_3*(-px2(m)*cy2+py2(m)*cx2)
844 fm12(3,3,m)=fm12(3,3,m)+ c3
845 fm14(3,3,m)=fm14(3,3,m)- c3
846
847 j=2
848
849 cx2 = phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m)
850 cy2 = phky(m)*phkrz(j,m)+phey(m)*pherz(j,m)
851
852 c3 = rz_3*(-px1(m)*cy2+py1(m)*cx2)
853 mf12(3,3,m)=mf12(3,3,m)+ c3
854 fm23(3,3,m)=fm23(3,3,m)- c3
855
856 c3 = rz_3*(-px2(m)*cy2+py2(m)*cx2)
857 mf22(3,3,m)=mf22(3,3,m)+ c3
858 fm24(3,3,m)=fm24(3,3,m)- c3
859
860 j=3
861
862 cx2 = phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m)
863 cy2 = phky(m)*phkrz(j,m)+phey(m)*pherz(j,m)
864
865 c3 = rz_3*(-px1(m)*cy2+py1(m)*cx2)
866 mf13(3,3,m)=mf13(3,3,m)+ c3
867 mf33(3,3,m)=mf33(3,3,m)- c3
868
869 c3 = rz_3*(-px2(m)*cy2+py2(m)*cx2)
870 mf23(3,3,m)=mf23(3,3,m)+ c3
871 fm34(3,3,m)=fm34(3,3,m)- c3
872
873 j=4
874
875 cx2 = phkx(m)*phkrz(j,m)+phex(m)*pherz(j,m)
876 cy2 = phky(m)*phkrz(j,m)+phey(m)*pherz(j,m)
877
878 c3 = rz_3*(-px1(m)*cy2+py1(m)*cx2)
879 mf14(3,3,m)=mf14(3,3,m)+ c3
880 mf34(3,3,m)=mf34(3,3,m)- c3
881
882 c3 = rz_3*(-px2(m)*cy2+py2(m)*cx2)
883 mf24(3,3,m)=mf24(3,3,m)+ c3
884 mf44(3,3,m)=mf44(3,3,m)- c3
885 ENDDO
886
887 RETURN