Download Prometheus - Worcester Polytechnic Institute
Transcript
4.3 4.4 4.19 4.20 4.21 The obstacle inflation and path planning results of CostMap. . . . . . . . . . . . . . . . . . . How inflation is used to determine occupancy. Image courtesy of the CostMap 2D wiki(ROS, 2010). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Increased obstacle inflation and resulting path planning of CostMap. . . . . . . . . . . . . . . Portion of the code used to connect to the GPS client. . . . . . . . . . . . . . . . . . . . . . . Portion of the code used to send GPS goals to the path planner. . . . . . . . . . . . . . . . . Parameters used to constrain the path planner. . . . . . . . . . . . . . . . . . . . . . . . . . . The RXGraph output of 2012 Prometheus. . . . . . . . . . . . . . . . . . . . . . . . . . . . . Results of multiple trials of GPS Waypoint navigation. . . . . . . . . . . . . . . . . . . . . . . Operation of the extended Kalman Filter. Image courtesy of Welch & Bishop (1995) . . . . . The state vector of the system: GPS gives X and Y, Phi is given by the compass . . . . . . . Measurement noise covariance matrix R . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Distance tests for the encoder and compass . . . . . . . . . . . . . . . . . . . . . . . . . . . . System noise covariance matrix Q . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Measurement matrix H . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Implementation of the EKF in ROS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . LabVIEW Logging of Raw and Filtered data from encoders and Compass (Akmanalp et al., 2011) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . LabVIEW logging of Raw and Filtered Path from Sensor Data around Atwater Kent . . . . . The Hand Drawn Circle on the Ground . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . EKF, GPS, and Encoder Results . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5.1 5.2 5.3 5.4 5.5 Demonstration course with lines . . . . . . . . . . . . . . Demonstration course with cones and lines . . . . . . . . . Demonstration course with cones, lines and goals . . . . . Prometheus successfully avoiding a line with a goal on the Prometheus demonstrating its ability to locate obstacles . . . . . . 48 49 49 51 51 6.1 Prometheus navigating during the demonstration in Institute Park . . . . . . . . . . . . . . . 52 B.1 Description of the remote control and it’s various modes of operation. . . . . . . . . . . . . . 59 4.5 4.6 4.7 4.8 4.9 4.10 4.11 4.12 4.13 4.14 4.15 4.16 4.17 4.18 iv . . . . . . . . . . . . . . . . . . other side . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 37 37 38 38 38 39 39 40 42 42 43 43 44 44 44 45 45 45 46