mpathpersist: Fix invalid condition check
[multipath-tools/.git] / libmpathpersist / mpath_persist.c
1 #include <libdevmapper.h>
2 #include "defaults.h"
3 #include <sys/stat.h>
4 #include <sys/types.h>
5 #include <fcntl.h>
6 #include "vector.h"
7 #include "checkers.h"
8 #include "structs.h"
9 #include "structs_vec.h"
10 #include <libudev.h>
11
12 #include "prio.h"
13 #include <unistd.h>
14 #include "devmapper.h"
15 #include "debug.h"
16 #include "config.h"
17 #include "switchgroup.h"
18 #include "discovery.h"
19 #include "dmparser.h"
20 #include <ctype.h>
21 #include "propsel.h"
22 #include "util.h"
23
24 #include "mpath_persist.h"
25 #include "mpathpr.h"
26 #include "mpath_pr_ioctl.h"
27
28 #include <pthread.h>
29 #include <stdio.h>
30 #include <stdlib.h>
31 #include <string.h>
32 #include <errno.h>
33 #include <sys/resource.h>
34
35 #define __STDC_FORMAT_MACROS 1
36
37 extern struct udev *udev;
38
39 struct config *
40 mpath_lib_init (void)
41 {
42         struct config *conf;
43
44         conf = load_config(DEFAULT_CONFIGFILE);
45         if (!conf) {
46                 condlog(0, "Failed to initialize multipath config.");
47                 return NULL;
48         }
49
50         if (conf->max_fds) {
51                 struct rlimit fd_limit;
52
53                 fd_limit.rlim_cur = conf->max_fds;
54                 fd_limit.rlim_max = conf->max_fds;
55                 if (setrlimit(RLIMIT_NOFILE, &fd_limit) < 0)
56                         condlog(0, "can't set open fds limit to %d : %s",
57                                    conf->max_fds, strerror(errno));
58         }
59
60         return conf;
61 }
62
63 int
64 mpath_lib_exit (struct config *conf)
65 {
66         dm_lib_release();
67         dm_lib_exit();
68         cleanup_prio();
69         cleanup_checkers();
70         free_config(conf);
71         conf = NULL;
72         return 0;
73 }
74
75 static int
76 updatepaths (struct multipath * mpp)
77 {
78         int i, j;
79         struct pathgroup * pgp;
80         struct path * pp;
81         struct config *conf;
82
83         if (!mpp->pg)
84                 return 0;
85
86         vector_foreach_slot (mpp->pg, pgp, i){
87                 if (!pgp->paths)
88                         continue;
89
90                 vector_foreach_slot (pgp->paths, pp, j){
91                         if (!strlen(pp->dev)){
92                                 if (devt2devname(pp->dev, FILE_NAME_SIZE,
93                                                  pp->dev_t)){
94                                         /*
95                                          * path is not in sysfs anymore
96                                          */
97                                         pp->state = PATH_DOWN;
98                                         continue;
99                                 }
100                                 pp->mpp = mpp;
101                                 conf = get_multipath_config();
102                                 pathinfo(pp, conf, DI_ALL);
103                                 put_multipath_config(conf);
104                                 continue;
105                         }
106                         pp->mpp = mpp;
107                         if (pp->state == PATH_UNCHECKED ||
108                                         pp->state == PATH_WILD) {
109                                 conf = get_multipath_config();
110                                 pathinfo(pp, conf, DI_CHECKER);
111                                 put_multipath_config(conf);
112                         }
113
114                         if (pp->priority == PRIO_UNDEF) {
115                                 conf = get_multipath_config();
116                                 pathinfo(pp, conf, DI_PRIO);
117                                 put_multipath_config(conf);
118                         }
119                 }
120         }
121         return 0;
122 }
123
124 int
125 mpath_prin_activepath (struct multipath *mpp, int rq_servact,
126         struct prin_resp * resp, int noisy)
127 {
128         int i,j, ret = MPATH_PR_DMMP_ERROR;
129         struct pathgroup *pgp = NULL;
130         struct path *pp = NULL;
131
132         vector_foreach_slot (mpp->pg, pgp, j){
133                 vector_foreach_slot (pgp->paths, pp, i){
134                         if (!((pp->state == PATH_UP) ||
135                               (pp->state == PATH_GHOST))){
136                                 condlog(2, "%s: %s not available. Skip.",
137                                         mpp->wwid, pp->dev);
138                                 condlog(3, "%s: status = %d.",
139                                         mpp->wwid, pp->state);
140                                 continue;
141                         }
142
143                         condlog(3, "%s: sending pr in command to %s ",
144                                 mpp->wwid, pp->dev);
145                         ret = mpath_send_prin_activepath(pp->dev, rq_servact,
146                                                          resp, noisy);
147                         switch(ret)
148                         {
149                                 case MPATH_PR_SUCCESS:
150                                 case MPATH_PR_SENSE_INVALID_OP:
151                                         return ret;
152                                 default:
153                                         continue;
154                         }
155                 }
156         }
157         return ret;
158 }
159
160 int mpath_persistent_reserve_in (int fd, int rq_servact,
161         struct prin_resp *resp, int noisy, int verbose)
162 {
163         struct stat info;
164         vector curmp = NULL;
165         vector pathvec = NULL;
166         char * alias;
167         struct multipath * mpp;
168         int map_present;
169         int major, minor;
170         int ret;
171         struct config *conf;
172
173         conf = get_multipath_config();
174         conf->verbosity = verbose;
175         put_multipath_config(conf);
176
177         if (fstat( fd, &info) != 0){
178                 condlog(0, "stat error %d", fd);
179                 return MPATH_PR_FILE_ERROR;
180         }
181         if(!S_ISBLK(info.st_mode)){
182                 condlog(0, "Failed to get major:minor. fd = %d", fd);
183                 return MPATH_PR_FILE_ERROR;
184         }
185
186         major = major(info.st_rdev);
187         minor = minor(info.st_rdev);
188         condlog(4, "Device %d:%d:  ", major, minor);
189
190         /* get alias from major:minor*/
191         alias = dm_mapname(major, minor);
192         if (!alias){
193                 condlog(0, "%d:%d failed to get device alias.", major, minor);
194                 return MPATH_PR_DMMP_ERROR;
195         }
196
197         condlog(3, "alias = %s", alias);
198         map_present = dm_map_present(alias);
199         if (map_present && !dm_is_mpath(alias)){
200                 condlog( 0, "%s: not a multipath device.", alias);
201                 ret = MPATH_PR_DMMP_ERROR;
202                 goto out;
203         }
204
205         /*
206          * allocate core vectors to store paths and multipaths
207          */
208         curmp = vector_alloc ();
209         pathvec = vector_alloc ();
210
211         if (!curmp || !pathvec){
212                 condlog (0, "%s: vector allocation failed.", alias);
213                 ret = MPATH_PR_DMMP_ERROR;
214                 if (curmp)
215                         vector_free(curmp);
216                 if (pathvec)
217                         vector_free(pathvec);
218                 goto out;
219         }
220
221         if (path_discovery(pathvec, DI_SYSFS | DI_CHECKER) < 0) {
222                 ret = MPATH_PR_DMMP_ERROR;
223                 goto out1;
224         }
225
226         /* get info of all paths from the dm device     */
227         if (get_mpvec (curmp, pathvec, alias)){
228                 condlog(0, "%s: failed to get device info.", alias);
229                 ret = MPATH_PR_DMMP_ERROR;
230                 goto out1;
231         }
232
233         mpp = find_mp_by_alias(curmp, alias);
234         if (!mpp){
235                 condlog(0, "%s: devmap not registered.", alias);
236                 ret = MPATH_PR_DMMP_ERROR;
237                 goto out1;
238         }
239
240         ret = mpath_prin_activepath(mpp, rq_servact, resp, noisy);
241
242 out1:
243         free_multipathvec(curmp, KEEP_PATHS);
244         free_pathvec(pathvec, FREE_PATHS);
245 out:
246         FREE(alias);
247         return ret;
248 }
249
250 int mpath_persistent_reserve_out ( int fd, int rq_servact, int rq_scope,
251         unsigned int rq_type, struct prout_param_descriptor *paramp, int noisy, int verbose)
252 {
253
254         struct stat info;
255
256         vector curmp = NULL;
257         vector pathvec = NULL;
258
259         char * alias;
260         struct multipath * mpp;
261         int map_present;
262         int major, minor;
263         int ret;
264         uint64_t prkey;
265         struct config *conf;
266
267         conf = get_multipath_config();
268         conf->verbosity = verbose;
269         put_multipath_config(conf);
270
271         if (fstat( fd, &info) != 0){
272                 condlog(0, "stat error fd=%d", fd);
273                 return MPATH_PR_FILE_ERROR;
274         }
275
276         if(!S_ISBLK(info.st_mode)){
277                 condlog(3, "Failed to get major:minor. fd=%d", fd);
278                 return MPATH_PR_FILE_ERROR;
279         }
280
281         major = major(info.st_rdev);
282         minor = minor(info.st_rdev);
283         condlog(4, "Device  %d:%d", major, minor);
284
285         /* get WWN of the device from major:minor*/
286         alias = dm_mapname(major, minor);
287         if (!alias){
288                 return MPATH_PR_DMMP_ERROR;
289         }
290
291         condlog(3, "alias = %s", alias);
292         map_present = dm_map_present(alias);
293
294         if (map_present && !dm_is_mpath(alias)){
295                 condlog(3, "%s: not a multipath device.", alias);
296                 ret = MPATH_PR_DMMP_ERROR;
297                 goto out;
298         }
299
300         /*
301          * allocate core vectors to store paths and multipaths
302          */
303         curmp = vector_alloc ();
304         pathvec = vector_alloc ();
305
306         if (!curmp || !pathvec){
307                 condlog (0, "%s: vector allocation failed.", alias);
308                 ret = MPATH_PR_DMMP_ERROR;
309                 if (curmp)
310                         vector_free(curmp);
311                 if (pathvec)
312                         vector_free(pathvec);
313                 goto out;
314         }
315
316         if (path_discovery(pathvec, DI_SYSFS | DI_CHECKER) < 0) {
317                 ret = MPATH_PR_DMMP_ERROR;
318                 goto out1;
319         }
320
321         /* get info of all paths from the dm device     */
322         if (get_mpvec(curmp, pathvec, alias)){
323                 condlog(0, "%s: failed to get device info.", alias);
324                 ret = MPATH_PR_DMMP_ERROR;
325                 goto out1;
326         }
327
328         mpp = find_mp_by_alias(curmp, alias);
329
330         if (!mpp) {
331                 condlog(0, "%s: devmap not registered.", alias);
332                 ret = MPATH_PR_DMMP_ERROR;
333                 goto out1;
334         }
335
336         conf = get_multipath_config();
337         select_reservation_key(conf, mpp);
338         put_multipath_config(conf);
339
340         memcpy(&prkey, paramp->sa_key, 8);
341         if (mpp->prkey_source == PRKEY_SOURCE_FILE && prkey &&
342             ((!get_be64(mpp->reservation_key) &&
343               rq_servact == MPATH_PROUT_REG_SA) ||
344              rq_servact == MPATH_PROUT_REG_IGN_SA)) {
345                 memcpy(&mpp->reservation_key, paramp->sa_key, 8);
346                 if (update_prkey(alias, get_be64(mpp->reservation_key))) {
347                         condlog(0, "%s: failed to set prkey for multipathd.",
348                                 alias);
349                         ret = MPATH_PR_DMMP_ERROR;
350                         goto out1;
351                 }
352         }
353
354         if (memcmp(paramp->key, &mpp->reservation_key, 8) &&
355             memcmp(paramp->sa_key, &mpp->reservation_key, 8)) {
356                 condlog(0, "%s: configured reservation key doesn't match: 0x%" PRIx64, alias, get_be64(mpp->reservation_key));
357                 ret = MPATH_PR_SYNTAX_ERROR;
358                 goto out1;
359         }
360
361         switch(rq_servact)
362         {
363         case MPATH_PROUT_REG_SA:
364         case MPATH_PROUT_REG_IGN_SA:
365                 ret= mpath_prout_reg(mpp, rq_servact, rq_scope, rq_type, paramp, noisy);
366                 break;
367         case MPATH_PROUT_RES_SA :
368         case MPATH_PROUT_PREE_SA :
369         case MPATH_PROUT_PREE_AB_SA :
370         case MPATH_PROUT_CLEAR_SA:
371                 ret = mpath_prout_common(mpp, rq_servact, rq_scope, rq_type, paramp, noisy);
372                 break;
373         case MPATH_PROUT_REL_SA:
374                 ret = mpath_prout_rel(mpp, rq_servact, rq_scope, rq_type, paramp, noisy);
375                 break;
376         default:
377                 ret = MPATH_PR_OTHER;
378                 goto out1;
379         }
380
381         if ((ret == MPATH_PR_SUCCESS) && ((rq_servact == MPATH_PROUT_REG_SA) ||
382                                 (rq_servact ==  MPATH_PROUT_REG_IGN_SA)))
383         {
384                 if (prkey == 0) {
385                         update_prflag(alias, 0);
386                         update_prkey(alias, 0);
387                 } else
388                         update_prflag(alias, 1);
389         } else if ((ret == MPATH_PR_SUCCESS) && (rq_servact == MPATH_PROUT_CLEAR_SA)) {
390                 update_prflag(alias, 0);
391                 update_prkey(alias, 0);
392         }
393 out1:
394         free_multipathvec(curmp, KEEP_PATHS);
395         free_pathvec(pathvec, FREE_PATHS);
396
397 out:
398         FREE(alias);
399         return ret;
400 }
401
402 int
403 get_mpvec (vector curmp, vector pathvec, char * refwwid)
404 {
405         int i;
406         struct multipath *mpp;
407         char params[PARAMS_SIZE], status[PARAMS_SIZE];
408
409         if (dm_get_maps (curmp)){
410                 return 1;
411         }
412
413         vector_foreach_slot (curmp, mpp, i){
414                 /*
415                  * discard out of scope maps
416                  */
417                 if (mpp->alias && refwwid &&
418                     strncmp (mpp->alias, refwwid, WWID_SIZE - 1)){
419                         free_multipath (mpp, KEEP_PATHS);
420                         vector_del_slot (curmp, i);
421                         i--;
422                         continue;
423                 }
424
425                 dm_get_map(mpp->alias, &mpp->size, params);
426                 condlog(3, "params = %s", params);
427                 dm_get_status(mpp->alias, status);
428                 condlog(3, "status = %s", status);
429                 disassemble_map (pathvec, params, mpp, 0);
430
431                 /*
432                  * disassemble_map() can add new paths to pathvec.
433                  * If not in "fast list mode", we need to fetch information
434                  * about them
435                  */
436                 updatepaths(mpp);
437                 mpp->bestpg = select_path_group (mpp);
438                 disassemble_status (status, mpp);
439
440         }
441         return MPATH_PR_SUCCESS ;
442 }
443
444 int mpath_send_prin_activepath (char * dev, int rq_servact,
445                                 struct prin_resp * resp, int noisy)
446 {
447
448         int rc;
449
450         rc = prin_do_scsi_ioctl(dev, rq_servact, resp,  noisy);
451
452         return (rc);
453 }
454
455 int mpath_prout_reg(struct multipath *mpp,int rq_servact, int rq_scope,
456         unsigned int rq_type, struct prout_param_descriptor * paramp, int noisy)
457 {
458
459         int i, j;
460         struct pathgroup *pgp = NULL;
461         struct path *pp = NULL;
462         int rollback = 0;
463         int active_pathcount=0;
464         int rc;
465         int count=0;
466         int status = MPATH_PR_SUCCESS;
467         uint64_t sa_key = 0;
468
469         if (!mpp)
470                 return MPATH_PR_DMMP_ERROR;
471
472         active_pathcount = pathcount(mpp, PATH_UP) + pathcount(mpp, PATH_GHOST);
473
474         if (active_pathcount == 0) {
475                 condlog (0, "%s: no path available", mpp->wwid);
476                 return MPATH_PR_DMMP_ERROR;
477         }
478
479         if ( paramp->sa_flags & MPATH_F_ALL_TG_PT_MASK ) {
480                 condlog (1, "Warning: ALL_TG_PT is set. Configuration not supported");
481         }
482
483         struct threadinfo thread[active_pathcount];
484
485         memset(thread, 0, sizeof(thread));
486
487         /* init thread parameter */
488         for (i =0; i< active_pathcount; i++){
489                 thread[i].param.rq_servact = rq_servact;
490                 thread[i].param.rq_scope = rq_scope;
491                 thread[i].param.rq_type = rq_type;
492                 thread[i].param.paramp = paramp;
493                 thread[i].param.noisy = noisy;
494                 thread[i].param.status = MPATH_PR_SKIP;
495
496                 condlog (3, "THRED ID [%d] INFO]", i);
497                 condlog (3, "rq_servact=%d ", thread[i].param.rq_servact);
498                 condlog (3, "rq_scope=%d ", thread[i].param.rq_scope);
499                 condlog (3, "rq_type=%d ", thread[i].param.rq_type);
500                 condlog (3, "rkey=");
501                 condlog (3, "paramp->sa_flags =%02x ",
502                          thread[i].param.paramp->sa_flags);
503                 condlog (3, "noisy=%d ", thread[i].param.noisy);
504                 condlog (3, "status=%d ", thread[i].param.status);
505         }
506
507         pthread_attr_t attr;
508         pthread_attr_init(&attr);
509         pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_JOINABLE);
510
511         vector_foreach_slot (mpp->pg, pgp, j){
512                 vector_foreach_slot (pgp->paths, pp, i){
513                         if (!((pp->state == PATH_UP) || (pp->state == PATH_GHOST))){
514                                 condlog (1, "%s: %s path not up. Skip.", mpp->wwid, pp->dev);
515                                 continue;
516                         }
517                         strncpy(thread[count].param.dev, pp->dev,
518                                 FILE_NAME_SIZE - 1);
519
520                         if (count && (thread[count].param.paramp->sa_flags & MPATH_F_SPEC_I_PT_MASK)){
521                                 /*
522                                  * Clearing SPEC_I_PT as transportids are already registered by now.
523                                  */
524                                 thread[count].param.paramp->sa_flags &= (~MPATH_F_SPEC_I_PT_MASK);
525                         }
526
527                         condlog (3, "%s: sending pr out command to %s", mpp->wwid, pp->dev);
528
529                         rc = pthread_create(&thread[count].id, &attr, mpath_prout_pthread_fn, (void *)(&thread[count].param));
530                         if (rc){
531                                 condlog (0, "%s: failed to create thread %d", mpp->wwid, rc);
532                                 thread[count].param.status = MPATH_PR_THREAD_ERROR;
533                         }
534                         count = count + 1;
535                 }
536         }
537         for( i=0; i < active_pathcount ; i++){
538                 if (thread[i].param.status != MPATH_PR_THREAD_ERROR) {
539                         rc = pthread_join(thread[i].id, NULL);
540                         if (rc){
541                                 condlog (0, "%s: Thread[%d] failed to join thread %d", mpp->wwid, i, rc);
542                         }
543                 }
544                 if (!rollback && (thread[i].param.status == MPATH_PR_RESERV_CONFLICT)){
545                         rollback = 1;
546                         sa_key = 0;
547                         for (i = 0; i < 8; ++i){
548                                 if (i > 0)
549                                         sa_key <<= 8;
550                                 sa_key |= paramp->sa_key[i];
551                         }
552                         status = MPATH_PR_RESERV_CONFLICT ;
553                 }
554                 if (!rollback && (status == MPATH_PR_SUCCESS)){
555                         status = thread[i].param.status;
556                 }
557         }
558         if (rollback && ((rq_servact == MPATH_PROUT_REG_SA) && sa_key != 0 )){
559                 condlog (3, "%s: ERROR: initiating pr out rollback", mpp->wwid);
560                 for( i=0 ; i < active_pathcount ; i++){
561                         if(thread[i].param.status == MPATH_PR_SUCCESS) {
562                                 memcpy(&thread[i].param.paramp->key, &thread[i].param.paramp->sa_key, 8);
563                                 memset(&thread[i].param.paramp->sa_key, 0, 8);
564                                 thread[i].param.status = MPATH_PR_SUCCESS;
565                                 rc = pthread_create(&thread[i].id, &attr, mpath_prout_pthread_fn,
566                                                 (void *)(&thread[i].param));
567                                 if (rc){
568                                         condlog (0, "%s: failed to create thread for rollback. %d",  mpp->wwid, rc);
569                                         thread[i].param.status = MPATH_PR_THREAD_ERROR;
570                                 }
571                         } else
572                                 thread[i].param.status = MPATH_PR_SKIP;
573                 }
574                 for(i=0; i < active_pathcount ; i++){
575                         if (thread[i].param.status != MPATH_PR_SKIP &&
576                             thread[i].param.status != MPATH_PR_THREAD_ERROR) {
577                                 rc = pthread_join(thread[i].id, NULL);
578                                 if (rc){
579                                         condlog (3, "%s: failed to join thread while rolling back %d",
580                                                  mpp->wwid, i);
581                                 }
582                         }
583                 }
584         }
585
586         pthread_attr_destroy(&attr);
587         return (status);
588 }
589
590 void * mpath_prout_pthread_fn(void *p)
591 {
592         int ret;
593         struct prout_param * param = (struct prout_param *)p;
594
595         ret = prout_do_scsi_ioctl( param->dev,param->rq_servact, param->rq_scope,
596                         param->rq_type, param->paramp, param->noisy);
597         param->status = ret;
598         pthread_exit(NULL);
599 }
600
601 int mpath_prout_common(struct multipath *mpp,int rq_servact, int rq_scope,
602         unsigned int rq_type, struct prout_param_descriptor* paramp, int noisy)
603 {
604         int i,j, ret;
605         struct pathgroup *pgp = NULL;
606         struct path *pp = NULL;
607
608         vector_foreach_slot (mpp->pg, pgp, j){
609                 vector_foreach_slot (pgp->paths, pp, i){
610                         if (!((pp->state == PATH_UP) || (pp->state == PATH_GHOST))){
611                                 condlog (1, "%s: %s path not up. Skip",
612                                          mpp->wwid, pp->dev);
613                                 continue;
614                         }
615
616                         condlog (3, "%s: sending pr out command to %s", mpp->wwid, pp->dev);
617                         ret = send_prout_activepath(pp->dev, rq_servact,
618                                                     rq_scope, rq_type,
619                                                     paramp, noisy);
620                         return ret ;
621                 }
622         }
623         return MPATH_PR_SUCCESS;
624 }
625
626 int send_prout_activepath(char * dev, int rq_servact, int rq_scope,
627         unsigned int rq_type, struct prout_param_descriptor * paramp, int noisy)
628 {
629         struct prout_param param;
630         param.rq_servact = rq_servact;
631         param.rq_scope  = rq_scope;
632         param.rq_type   = rq_type;
633         param.paramp    = paramp;
634         param.noisy = noisy;
635         param.status = -1;
636
637         pthread_t thread;
638         pthread_attr_t attr;
639         int rc;
640
641         memset(&thread, 0, sizeof(thread));
642         strncpy(param.dev, dev, FILE_NAME_SIZE - 1);
643         /* Initialize and set thread joinable attribute */
644         pthread_attr_init(&attr);
645         pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_JOINABLE);
646
647         rc = pthread_create(&thread, &attr, mpath_prout_pthread_fn, (void *)(&param));
648         if (rc){
649                 condlog (3, "%s: failed to create thread %d", dev, rc);
650                 return MPATH_PR_THREAD_ERROR;
651         }
652         /* Free attribute and wait for the other threads */
653         pthread_attr_destroy(&attr);
654         rc = pthread_join(thread, NULL);
655
656         return (param.status);
657 }
658
659 int mpath_prout_rel(struct multipath *mpp,int rq_servact, int rq_scope,
660         unsigned int rq_type, struct prout_param_descriptor * paramp, int noisy)
661 {
662         int i, j;
663         int num = 0;
664         struct pathgroup *pgp = NULL;
665         struct path *pp = NULL;
666         int active_pathcount = 0;
667         pthread_attr_t attr;
668         int rc, found = 0;
669         int count = 0;
670         int status = MPATH_PR_SUCCESS;
671         struct prin_resp resp;
672         struct prout_param_descriptor *pamp;
673         struct prin_resp *pr_buff;
674         int length;
675         struct transportid *pptr;
676
677         if (!mpp)
678                 return MPATH_PR_DMMP_ERROR;
679
680         active_pathcount = pathcount (mpp, PATH_UP) + pathcount (mpp, PATH_GHOST);
681
682         struct threadinfo thread[active_pathcount];
683         memset(thread, 0, sizeof(thread));
684         for (i = 0; i < active_pathcount; i++){
685                 thread[i].param.rq_servact = rq_servact;
686                 thread[i].param.rq_scope = rq_scope;
687                 thread[i].param.rq_type = rq_type;
688                 thread[i].param.paramp = paramp;
689                 thread[i].param.noisy = noisy;
690                 thread[i].param.status = MPATH_PR_SKIP;
691
692                 condlog (3, " path count = %d", i);
693                 condlog (3, "rq_servact=%d ", thread[i].param.rq_servact);
694                 condlog (3, "rq_scope=%d ", thread[i].param.rq_scope);
695                 condlog (3, "rq_type=%d ", thread[i].param.rq_type);
696                 condlog (3, "noisy=%d ", thread[i].param.noisy);
697                 condlog (3, "status=%d ", thread[i].param.status);
698         }
699
700         pthread_attr_init (&attr);
701         pthread_attr_setdetachstate (&attr, PTHREAD_CREATE_JOINABLE);
702
703         vector_foreach_slot (mpp->pg, pgp, j){
704                 vector_foreach_slot (pgp->paths, pp, i){
705                         if (!((pp->state == PATH_UP) || (pp->state == PATH_GHOST))){
706                                 condlog (1, "%s: %s path not up.", mpp->wwid, pp->dev);
707                                 continue;
708                         }
709
710                         strncpy(thread[count].param.dev, pp->dev,
711                                 FILE_NAME_SIZE - 1);
712                         condlog (3, "%s: sending pr out command to %s", mpp->wwid, pp->dev);
713                         rc = pthread_create (&thread[count].id, &attr, mpath_prout_pthread_fn,
714                                         (void *) (&thread[count].param));
715                         if (rc) {
716                                 condlog (0, "%s: failed to create thread. %d",  mpp->wwid, rc);
717                                 thread[count].param.status = MPATH_PR_THREAD_ERROR;
718                         }
719                         count = count + 1;
720                 }
721         }
722         pthread_attr_destroy (&attr);
723         for (i = 0; i < active_pathcount; i++){
724                 if (thread[i].param.status != MPATH_PR_THREAD_ERROR) {
725                         rc = pthread_join (thread[i].id, NULL);
726                         if (rc){
727                                 condlog (1, "%s: failed to join thread.  %d",  mpp->wwid,  rc);
728                         }
729                 }
730         }
731
732         for (i = 0; i < active_pathcount; i++){
733                 /*  check thread status here and return the status */
734
735                 if (thread[i].param.status == MPATH_PR_RESERV_CONFLICT)
736                         status = MPATH_PR_RESERV_CONFLICT;
737                 else if (status == MPATH_PR_SUCCESS
738                                 && thread[i].param.status != MPATH_PR_RESERV_CONFLICT)
739                         status = thread[i].param.status;
740         }
741
742         status = mpath_prin_activepath (mpp, MPATH_PRIN_RRES_SA, &resp, noisy);
743         if (status != MPATH_PR_SUCCESS){
744                 condlog (0, "%s: pr in read reservation command failed.", mpp->wwid);
745                 return MPATH_PR_OTHER;
746         }
747
748         num = resp.prin_descriptor.prin_readresv.additional_length / 8;
749         if (num == 0){
750                 condlog (2, "%s: Path holding reservation is released.", mpp->wwid);
751                 return MPATH_PR_SUCCESS;
752         }
753         condlog (2, "%s: Path holding reservation is not avialable.", mpp->wwid);
754
755         pr_buff =  mpath_alloc_prin_response(MPATH_PRIN_RFSTAT_SA);
756         if (!pr_buff){
757                 condlog (0, "%s: failed to  alloc pr in response buffer.", mpp->wwid);
758                 return MPATH_PR_OTHER;
759         }
760
761         status = mpath_prin_activepath (mpp, MPATH_PRIN_RFSTAT_SA, pr_buff, noisy);
762
763         if (status != MPATH_PR_SUCCESS){
764                 condlog (0,  "%s: pr in read full status command failed.",  mpp->wwid);
765                 goto out;
766         }
767
768         num = pr_buff->prin_descriptor.prin_readfd.number_of_descriptor;
769         if (0 == num){
770                 goto out;
771         }
772         length = sizeof (struct prout_param_descriptor) + (sizeof (struct transportid *));
773
774         pamp = (struct prout_param_descriptor *)malloc (length);
775         if (!pamp){
776                 condlog (0, "%s: failed to alloc pr out parameter.", mpp->wwid);
777                 goto out1;
778         }
779
780         memset(pamp, 0, length);
781
782         pamp->trnptid_list[0] = (struct transportid *) malloc (sizeof (struct transportid));
783         if (!pamp->trnptid_list[0]){
784                 condlog (0, "%s: failed to alloc pr out transportid.", mpp->wwid);
785                 goto out1;
786         }
787
788         if (get_be64(mpp->reservation_key)){
789                 memcpy (pamp->key, &mpp->reservation_key, 8);
790                 condlog (3, "%s: reservation key set.", mpp->wwid);
791         }
792
793         status = mpath_prout_common (mpp, MPATH_PROUT_CLEAR_SA,
794                                      rq_scope, rq_type, pamp, noisy);
795
796         if (status) {
797                 condlog(0, "%s: failed to send CLEAR_SA", mpp->wwid);
798                 goto out1;
799         }
800
801         pamp->num_transportid = 1;
802         pptr=pamp->trnptid_list[0];
803
804         for (i = 0; i < num; i++){
805                 if (get_be64(mpp->reservation_key) &&
806                         memcmp(pr_buff->prin_descriptor.prin_readfd.descriptors[i]->key,
807                                &mpp->reservation_key, 8)){
808                         /*register with tarnsport id*/
809                         memset(pamp, 0, length);
810                         pamp->trnptid_list[0] = pptr;
811                         memset (pamp->trnptid_list[0], 0, sizeof (struct transportid));
812                         memcpy (pamp->sa_key,
813                                         pr_buff->prin_descriptor.prin_readfd.descriptors[i]->key, 8);
814                         pamp->sa_flags = MPATH_F_SPEC_I_PT_MASK;
815                         pamp->num_transportid = 1;
816
817                         memcpy (pamp->trnptid_list[0],
818                                         &pr_buff->prin_descriptor.prin_readfd.descriptors[i]->trnptid,
819                                         sizeof (struct transportid));
820                         status = mpath_prout_common (mpp, MPATH_PROUT_REG_SA, 0, rq_type,
821                                         pamp, noisy);
822
823                         pamp->sa_flags = 0;
824                         memcpy (pamp->key, pr_buff->prin_descriptor.prin_readfd.descriptors[i]->key, 8);
825                         memset (pamp->sa_key, 0, 8);
826                         pamp->num_transportid = 0;
827                         status = mpath_prout_common (mpp, MPATH_PROUT_REG_SA, 0, rq_type,
828                                         pamp, noisy);
829                 }
830                 else
831                 {
832                         if (get_be64(mpp->reservation_key))
833                                 found = 1;
834                 }
835
836
837         }
838
839         if (found){
840                 memset (pamp, 0, length);
841                 memcpy (pamp->sa_key, &mpp->reservation_key, 8);
842                 memset (pamp->key, 0, 8);
843                 status = mpath_prout_reg(mpp, MPATH_PROUT_REG_SA, rq_scope, rq_type, pamp, noisy);
844         }
845
846
847         free(pptr);
848 out1:
849         free (pamp);
850 out:
851         free (pr_buff);
852         return (status);
853 }
854
855 void * mpath_alloc_prin_response(int prin_sa)
856 {
857         void * ptr = NULL;
858         int size=0;
859         switch (prin_sa)
860         {
861                 case MPATH_PRIN_RKEY_SA:
862                         size = sizeof(struct prin_readdescr);
863                         break;
864                 case MPATH_PRIN_RRES_SA:
865                         size = sizeof(struct prin_resvdescr);
866                         break;
867                 case MPATH_PRIN_RCAP_SA:
868                         size=sizeof(struct prin_capdescr);
869                         break;
870                 case MPATH_PRIN_RFSTAT_SA:
871                         size = sizeof(struct print_fulldescr_list) +
872                                 sizeof(struct prin_fulldescr *)*MPATH_MX_TIDS;
873                         break;
874         }
875         if (size > 0)
876         {
877                 ptr = calloc(size, 1);
878         }
879         return ptr;
880 }
881
882 int update_map_pr(struct multipath *mpp)
883 {
884         int noisy=0;
885         struct prin_resp *resp;
886         int i, ret, isFound;
887
888         if (!get_be64(mpp->reservation_key))
889         {
890                 /* Nothing to do. Assuming pr mgmt feature is disabled*/
891                 condlog(3, "%s: reservation_key not set in multipath.conf", mpp->alias);
892                 return MPATH_PR_SUCCESS;
893         }
894
895         resp = mpath_alloc_prin_response(MPATH_PRIN_RKEY_SA);
896         if (!resp)
897         {
898                 condlog(0,"%s : failed to alloc resp in update_map_pr", mpp->alias);
899                 return MPATH_PR_OTHER;
900         }
901         ret = mpath_prin_activepath(mpp, MPATH_PRIN_RKEY_SA, resp, noisy);
902
903         if (ret != MPATH_PR_SUCCESS )
904         {
905                 condlog(0,"%s : pr in read keys service action failed Error=%d", mpp->alias, ret);
906                 free(resp);
907                 return  ret;
908         }
909
910         if (resp->prin_descriptor.prin_readkeys.additional_length == 0 )
911         {
912                 condlog(0,"%s: No key found. Device may not be registered. ", mpp->alias);
913                 free(resp);
914                 return MPATH_PR_SUCCESS;
915         }
916
917         condlog(2, "%s: Multipath  reservation_key: 0x%" PRIx64 " ", mpp->alias,
918                 get_be64(mpp->reservation_key));
919
920         isFound =0;
921         for (i = 0; i < resp->prin_descriptor.prin_readkeys.additional_length/8; i++ )
922         {
923                 condlog(2, "%s: PR IN READKEYS[%d]  reservation key:", mpp->alias, i);
924                 dumpHex((char *)&resp->prin_descriptor.prin_readkeys.key_list[i*8], 8 , 1);
925
926                 if (!memcmp(&mpp->reservation_key, &resp->prin_descriptor.prin_readkeys.key_list[i*8], 8))
927                 {
928                         condlog(2, "%s: reservation key found in pr in readkeys response", mpp->alias);
929                         isFound =1;
930                 }
931         }
932
933         if (isFound)
934         {
935                 mpp->prflag = 1;
936                 condlog(2, "%s: prflag flag set.", mpp->alias );
937         }
938
939         free(resp);
940         return MPATH_PR_SUCCESS;
941 }