12.06.2013 Views

"Applicazione di un laser range scanner a un robot mobile", 2010

"Applicazione di un laser range scanner a un robot mobile", 2010

"Applicazione di un laser range scanner a un robot mobile", 2010

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

{<br />

if(bit == 9) // this is also a motor stall bit<br />

{<br />

}<br />

bumpmask = bumpmask >> 1;<br />

bit--;<br />

continue;<br />

//printf("\n\tComparing stallval=%s to bumpmask=%s... ", int_as_bitstring(stallval).c_str(),<br />

int_as_bitstring(bumpmask).c_str());<br />

}<br />

if(cumulativeStallVal & bumpmask)<br />

printf("%d ", bump);<br />

bumpmask = bumpmask >> 1;<br />

bump++;<br />

// print pose of last bump sensor rea<strong>di</strong>ng<br />

const std::list* bumpsensed = bumpers.getCurrentBuffer();<br />

if(bumpsensed)<br />

{<br />

//printf("%d rea<strong>di</strong>ngs. ", bumpsensed->size());<br />

}<br />

puts("");<br />

if(bumpsensed->size() > 0 && bumpsensed->front()) {<br />

}<br />

printf("(%.0f,%.0f)", bumpsensed->front()->getX(), bumpsensed->front()->getY());<br />

51

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!