xref: /libpciaccess/src/common_iterator.c (revision e1a0240a)
15a04522aSIan Romanick /*
25a04522aSIan Romanick  * (C) Copyright IBM Corporation 2006
35a04522aSIan Romanick  * All Rights Reserved.
45a04522aSIan Romanick  *
55a04522aSIan Romanick  * Permission is hereby granted, free of charge, to any person obtaining a
65a04522aSIan Romanick  * copy of this software and associated documentation files (the "Software"),
75a04522aSIan Romanick  * to deal in the Software without restriction, including without limitation
85a04522aSIan Romanick  * on the rights to use, copy, modify, merge, publish, distribute, sub
95a04522aSIan Romanick  * license, and/or sell copies of the Software, and to permit persons to whom
105a04522aSIan Romanick  * the Software is furnished to do so, subject to the following conditions:
115a04522aSIan Romanick  *
125a04522aSIan Romanick  * The above copyright notice and this permission notice (including the next
135a04522aSIan Romanick  * paragraph) shall be included in all copies or substantial portions of the
145a04522aSIan Romanick  * Software.
155a04522aSIan Romanick  *
165a04522aSIan Romanick  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
175a04522aSIan Romanick  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
185a04522aSIan Romanick  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.  IN NO EVENT SHALL
195a04522aSIan Romanick  * IBM AND/OR THEIR SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
205a04522aSIan Romanick  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
215a04522aSIan Romanick  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
225a04522aSIan Romanick  * DEALINGS IN THE SOFTWARE.
235a04522aSIan Romanick  */
245a04522aSIan Romanick 
255a04522aSIan Romanick /**
265a04522aSIan Romanick  * \file common_iterator.c
275a04522aSIan Romanick  * Platform independent iterator support routines.
285a04522aSIan Romanick  *
295a04522aSIan Romanick  * \author Ian Romanick <[email protected]>
305a04522aSIan Romanick  */
315a04522aSIan Romanick 
325a04522aSIan Romanick #include <stdlib.h>
335a04522aSIan Romanick #include <string.h>
345a04522aSIan Romanick 
355a04522aSIan Romanick #include "pciaccess.h"
365a04522aSIan Romanick #include "pciaccess_private.h"
375a04522aSIan Romanick 
385a04522aSIan Romanick /**
395a04522aSIan Romanick  * Track device iteration state
405a04522aSIan Romanick  *
415a04522aSIan Romanick  * \private
425a04522aSIan Romanick  */
435a04522aSIan Romanick struct pci_device_iterator {
445a04522aSIan Romanick     unsigned next_index;
455a04522aSIan Romanick 
4664af050cSIan Romanick     enum {
4764af050cSIan Romanick 	match_any,
4864af050cSIan Romanick 	match_slot,
4964af050cSIan Romanick 	match_id
5064af050cSIan Romanick     } mode;
5164af050cSIan Romanick 
5264af050cSIan Romanick     union {
5364af050cSIan Romanick 	struct pci_slot_match   slot;
5464af050cSIan Romanick 	struct pci_id_match     id;
5564af050cSIan Romanick     } match;
5664af050cSIan Romanick };
575a04522aSIan Romanick 
585a04522aSIan Romanick 
595a04522aSIan Romanick /**
605a04522aSIan Romanick  * Create an iterator based on a regular expression.
615a04522aSIan Romanick  *
625a04522aSIan Romanick  * \return
635a04522aSIan Romanick  * A pointer to a fully initialized \c pci_device_iterator structure on
645a04522aSIan Romanick  * success, or \c NULL on failure.
655a04522aSIan Romanick  *
6664af050cSIan Romanick  * \sa pci_id_match_iterator_create, pci_device_next, pci_iterator_destroy
675a04522aSIan Romanick  */
685a04522aSIan Romanick struct pci_device_iterator *
pci_slot_match_iterator_create(const struct pci_slot_match * match)6964af050cSIan Romanick pci_slot_match_iterator_create( const struct pci_slot_match * match )
705a04522aSIan Romanick {
715a04522aSIan Romanick     struct pci_device_iterator * iter;
725a04522aSIan Romanick 
735a04522aSIan Romanick     if ( pci_sys == NULL ) {
745a04522aSIan Romanick 	return NULL;
755a04522aSIan Romanick     }
765a04522aSIan Romanick 
775a04522aSIan Romanick     iter = malloc( sizeof( *iter ) );
785a04522aSIan Romanick     if ( iter != NULL ) {
795a04522aSIan Romanick 	iter->next_index = 0;
805a04522aSIan Romanick 
8164af050cSIan Romanick 	if ( match != NULL ) {
8264af050cSIan Romanick 	    iter->mode = match_slot;
835a04522aSIan Romanick 
8464af050cSIan Romanick 	    (void) memcpy( & iter->match.slot, match, sizeof( *match ) );
855a04522aSIan Romanick 	}
865a04522aSIan Romanick 	else {
8764af050cSIan Romanick 	    iter->mode = match_any;
8864af050cSIan Romanick 	}
8964af050cSIan Romanick     }
9064af050cSIan Romanick 
9164af050cSIan Romanick     return iter;
9264af050cSIan Romanick }
9364af050cSIan Romanick 
9464af050cSIan Romanick 
9564af050cSIan Romanick /**
9664af050cSIan Romanick  * Create an iterator based on a regular expression.
9764af050cSIan Romanick  *
9864af050cSIan Romanick  * \return
9964af050cSIan Romanick  * A pointer to a fully initialized \c pci_device_iterator structure on
10064af050cSIan Romanick  * success, or \c NULL on failure.
10164af050cSIan Romanick  *
10264af050cSIan Romanick  * \sa pci_slot_match_iterator_create, pci_device_next, pci_iterator_destroy
10364af050cSIan Romanick  */
10464af050cSIan Romanick struct pci_device_iterator *
pci_id_match_iterator_create(const struct pci_id_match * match)10564af050cSIan Romanick pci_id_match_iterator_create( const struct pci_id_match * match )
10664af050cSIan Romanick {
10764af050cSIan Romanick     struct pci_device_iterator * iter;
10864af050cSIan Romanick 
10964af050cSIan Romanick     if ( pci_sys == NULL ) {
11064af050cSIan Romanick 	return NULL;
11164af050cSIan Romanick     }
11264af050cSIan Romanick 
11364af050cSIan Romanick     iter = malloc( sizeof( *iter ) );
11464af050cSIan Romanick     if ( iter != NULL ) {
11564af050cSIan Romanick 	iter->next_index = 0;
11664af050cSIan Romanick 
11764af050cSIan Romanick 	if ( match != NULL ) {
11864af050cSIan Romanick 	    iter->mode = match_id;
11964af050cSIan Romanick 
12064af050cSIan Romanick 	    (void) memcpy( & iter->match.id, match, sizeof( *match ) );
12164af050cSIan Romanick 	}
12264af050cSIan Romanick 	else {
12364af050cSIan Romanick 	    iter->mode = match_any;
1245a04522aSIan Romanick 	}
1255a04522aSIan Romanick     }
1265a04522aSIan Romanick 
1275a04522aSIan Romanick     return iter;
1285a04522aSIan Romanick }
1295a04522aSIan Romanick 
1305a04522aSIan Romanick 
1315a04522aSIan Romanick /**
1325a04522aSIan Romanick  * Destroy an iterator previously created with \c pci_iterator_create.
1335a04522aSIan Romanick  *
1345a04522aSIan Romanick  * \param iter  Iterator to be destroyed.
1355a04522aSIan Romanick  *
1365a04522aSIan Romanick  * \sa pci_device_next, pci_iterator_create
1375a04522aSIan Romanick  */
1385a04522aSIan Romanick void
pci_iterator_destroy(struct pci_device_iterator * iter)1395a04522aSIan Romanick pci_iterator_destroy( struct pci_device_iterator * iter )
1405a04522aSIan Romanick {
1415a04522aSIan Romanick     if ( iter != NULL ) {
1425a04522aSIan Romanick 	free( iter );
1435a04522aSIan Romanick     }
1445a04522aSIan Romanick }
1455a04522aSIan Romanick 
1465a04522aSIan Romanick 
1475a04522aSIan Romanick /**
1485a04522aSIan Romanick  * Iterate to the next PCI device.
1495a04522aSIan Romanick  *
1505a04522aSIan Romanick  * \param iter  Device iterator returned by \c pci_device_iterate.
1515a04522aSIan Romanick  *
1525a04522aSIan Romanick  * \return
1535a04522aSIan Romanick  * A pointer to a \c pci_device, or \c NULL when all devices have been
1545a04522aSIan Romanick  * iterated.
1555a04522aSIan Romanick  */
1565a04522aSIan Romanick struct pci_device *
pci_device_next(struct pci_device_iterator * iter)1575a04522aSIan Romanick pci_device_next( struct pci_device_iterator * iter )
1585a04522aSIan Romanick {
1595a04522aSIan Romanick     struct pci_device_private * d = NULL;
1605a04522aSIan Romanick 
161*4586bb67SAdam Jackson     if (!iter)
162*4586bb67SAdam Jackson 	return NULL;
163*4586bb67SAdam Jackson 
16464af050cSIan Romanick     switch( iter->mode ) {
16564af050cSIan Romanick     case match_any:
1665a04522aSIan Romanick 	if ( iter->next_index < pci_sys->num_devices ) {
1675a04522aSIan Romanick 	    d = & pci_sys->devices[ iter->next_index ];
1685a04522aSIan Romanick 	    iter->next_index++;
1695a04522aSIan Romanick 	}
17064af050cSIan Romanick 
17164af050cSIan Romanick 	break;
17264af050cSIan Romanick 
17364af050cSIan Romanick     case match_slot: {
1745a04522aSIan Romanick 	while ( iter->next_index < pci_sys->num_devices ) {
1755a04522aSIan Romanick 	    struct pci_device_private * const temp =
1765a04522aSIan Romanick 	      & pci_sys->devices[ iter->next_index ];
1775a04522aSIan Romanick 
1785a04522aSIan Romanick 	    iter->next_index++;
17964af050cSIan Romanick 	    if ( PCI_ID_COMPARE( iter->match.slot.domain, temp->base.domain )
18064af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.slot.bus, temp->base.bus )
18164af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.slot.dev, temp->base.dev )
18264af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.slot.func, temp->base.func ) ) {
1835a04522aSIan Romanick 		d = temp;
1845a04522aSIan Romanick 		break;
1855a04522aSIan Romanick 	    }
1865a04522aSIan Romanick 	}
18764af050cSIan Romanick 
18864af050cSIan Romanick 	break;
18964af050cSIan Romanick     }
19064af050cSIan Romanick 
19164af050cSIan Romanick     case match_id: {
19264af050cSIan Romanick 	while ( iter->next_index < pci_sys->num_devices ) {
19364af050cSIan Romanick 	    struct pci_device_private * const temp =
19464af050cSIan Romanick 	      & pci_sys->devices[ iter->next_index ];
19564af050cSIan Romanick 
19664af050cSIan Romanick 	    iter->next_index++;
19764af050cSIan Romanick 	    if ( PCI_ID_COMPARE( iter->match.id.vendor_id, temp->base.vendor_id )
19864af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.id.device_id, temp->base.device_id )
19964af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.id.subvendor_id, temp->base.subvendor_id )
20064af050cSIan Romanick 		 && PCI_ID_COMPARE( iter->match.id.subdevice_id, temp->base.subdevice_id )
20164af050cSIan Romanick 		 && ((temp->base.device_class & iter->match.id.device_class_mask)
20264af050cSIan Romanick 		     == iter->match.id.device_class) ) {
20364af050cSIan Romanick 		d = temp;
20464af050cSIan Romanick 		break;
20564af050cSIan Romanick 	    }
20664af050cSIan Romanick 	}
20764af050cSIan Romanick 
20864af050cSIan Romanick 	break;
20964af050cSIan Romanick     }
2105a04522aSIan Romanick     }
2115a04522aSIan Romanick 
2125a04522aSIan Romanick     return (struct pci_device *) d;
2135a04522aSIan Romanick }
21464af050cSIan Romanick 
21564af050cSIan Romanick 
21664af050cSIan Romanick struct pci_device *
pci_device_find_by_slot(uint32_t domain,uint32_t bus,uint32_t dev,uint32_t func)21764af050cSIan Romanick pci_device_find_by_slot( uint32_t domain, uint32_t bus, uint32_t dev,
21864af050cSIan Romanick 			 uint32_t func )
21964af050cSIan Romanick {
22064af050cSIan Romanick     struct pci_device_iterator  iter;
22164af050cSIan Romanick 
22264af050cSIan Romanick 
22364af050cSIan Romanick     iter.next_index = 0;
22464af050cSIan Romanick     iter.mode = match_slot;
22564af050cSIan Romanick     iter.match.slot.domain = domain;
22664af050cSIan Romanick     iter.match.slot.bus = bus;
22764af050cSIan Romanick     iter.match.slot.dev = dev;
22864af050cSIan Romanick     iter.match.slot.func = func;
22964af050cSIan Romanick 
23064af050cSIan Romanick     return pci_device_next( & iter );
23164af050cSIan Romanick }
232