Major project components: Sensors Robot hardware/software integration Kinematic model generation High-level control

Transcription

1 Status update: Path planning/following for a snake Major project components: Sensors Robot hardware/software integration Kinematic model generation High-level control

2 2. Optical mouse Optical mouse technology CMOS camera is to in resolution Center 5 5 region from new frame is compared to entirety of old frame Processing is optimized to detect translation The optical mouse is based on a main optical sensor with four main parts (Fig. 1): illumination device, illumination lens, camera and camera lens. Illumination is an important problem for a vision system. A light emitting diode (LED) with wavelength peak from 639 to 875 nm in combination with a plastic lens and mirrors is used to illuminate the surface under the sensor. The chip contains a CMOS camera as the image acquisition system and a proprietary DSP for image processing and external communications. The camera is very close to the floor surface, with 7.45 mm being the recommended height. The mouse structure protects Fig. 1. Optical mouse parts. 3. Optical mouse calibration The following results were obtained using a mouse with a declared resolution of mm pulses per millimeter or 400 cpi). The optica mouse is the HDNS-2000 type [19]. The mous were measured with a precision of ±0.05 mm an speed was limited to 1.5 mm/s to minimize the of the displacements. The pulses generated by th the displacement were obtained using a MATLA with all software tools and utilities that modify disabled. Finally, the x-axis refers to transversal ment and y-axis to longitudinal. Image from The optical mouse for indoor mobile robot odometry measurement, by J. Palacin, I Valgañon and R. Pernia. Sensors and Actuators A, 2006.

3 Mouse hardware

4 Arc verses Linear motion s and Actuators A 126 (2006) nt. ith rror ion ith ion nds sult gian Fig. 8. Mouse pulses measured when the sensor completes an arc of 45 at different radii (r): expected result according to initial linear calibration (triangles) and real measurements (circles). Table 1 Typical European indoor floor surfaces tested Arc motion severely underestimated Constant multiple between arc and linear motion pulse count Mitigation plan: If my tests duplicate this result, then will use a second filter on the mouse inputs, based on the estimated arc and linear motion components Tile type Color Fig. 9 Code Parameters (mm) Image from The optical mouse for indoor mobile robot odometry measurement, by J. Palacin, I a b d h Valgañon and R. Pernia. Sensors and Actuators A, Stoneware S1 Grey Stoneware S2 Grey Stoneware S3 Dark Ceramic C1 White Ceramic C2 Red Parquet P Wood

5 olution is mm (measuring pulses per millimeter) over the x-axis and mm (16.02 pulses per millimeter) over the y-axis, very close to the declared resolution with an average error of 1.27%. Sensor height 3.2. Height dependence The optical sensor can be placed for heights ranging from 7.15 to 7.75mm with 7.45mm as a recommended manufacturer Resolution goes down as sensor height goes up Mitigation plan: Use original mouse base to set sensor height, possibly with a suspension to keep it level. Fig. 3. Evolution of the standard deviation depending on the displacement. sensor Angular diagonal displacement In this experiment, the mouse was moved 30.0 mm diagonally at an angle varying from 0 (x-axis) to 90 (y-axis) to test the behavior of the optical sensor in angular displacements. Fig. 6 shows the diagonal pulses measured depending on the displace- Fig. 5. Influence of the height offset in the measured mouse pulses. Offset 0.0 corresponds to the original sensor height (7.35 mm). Image from The optical mouse for indoor mobile robot odometry measurement, by J. Palacin, I Valgañon and R. Pernia. Sensors and Actuators A, 2006.

6 Next Steps Add mice to snake Calibrate mice and compare to paper results Add center wheel-set to snake Get control software for snake motors

7 State Estimation & Path Planning for Scarab Rover Robot Motion Planning Fall 2007 Michael Dille Umashankar Nagarajan

8 Overview Primary goal: state estimation Fuse IMU data with downward pointing optic flow sensor Exercise in Kalman/Particle Filtering Path planning component A* and/or D* Lite in real or simulated obstacleladen environment

9 State Estimation Data used here is from the Zoe robot Application of Linear Kalman Filter to fuse IMU and GPS data to estimate the state Validate the state estimates with the existing {GPS, INS, Odometry} Kalman Filter The research goal is to do state estimation without GPS IMU and Odometry

10 Linear Kalman Filter Time Update Equations Measurement Update Equations

11 Sensors and Data available GPS (x,y,z) Position IMU Angular velocities along roll, pitch and yaw Linear Accelerations of x, y and z Odometry Distance Travelled

12 Discrete LKF implementation State is defined as (15x1 vector): [x,y,z,θ roll,θ pitch,θ yaw,dx,dy,dz,dθ roll,dθ pitch,dθ yaw,d 2 x,d 2 y,d 2 z] T Measurement vector is (9x1 vector): [x,y,z,dθ roll,dθ pitch,dθ yaw,d 2 x,d 2 y,d 2 z] T The matrix A used here represents the kinematic equations assuming that the motion on one dimension is independent of the other It is assumed that there is no control here i.e. U=0 The sensor model H maps the state variables to the measurement variables

13 Discrete LKF implementation There is an existing {GPS,INS,Odometry} Kalman Filter with which Discrete LKF implementation is validated The process error covariance matrix Q is: Q = E(v k,v kt ) v k = The measurement error covariance matrix R is derived using the confidence measures available from GPS data

14 Discrete LKF implementation Results

15 Discrete LKF implementation Results

16 Error Propagation What to do when no GPS or compass? E.g., on moon! Must use just odometry & IMU Have just [s forward dθ roll,dθ pitch,dθ yaw ] No absolute position/orientation fixes Error will grow without bound But can still track confidence! Just run Kalman prediction step & covariance update

17 Error Propagation With Orientation

18 Error Propagation No Orientation

19

20 Path Planning + Ultrasonic Mapping Sean Hyde

21 Path Planning + Ultrasonic Mapping Project Description: Construct and deploy a robot that will find path from start to goal using potential planning. The potential function for obstacles will include a probabilistic component based on how many of the 5 sensors can see the object and how close it is. Path Planning: Path planning will be done using a potential function with a probabilistic component. The robot will log its position by dead reckoning based on wheel encoders. Filtering: Filtering will be based on the work by Elfes and Morevac Demo scenario: Give the robot a deltax, deltay goal from its start position and let it loose!

22 Physical Construction 5 Ultrasonic Range sensors 2 Devantech SRF 04 3 Parallax Ping))) sensors 2 Wheel Differential Servo Drive Quadrature Optical encoders 44 spokes 176 transitions/revolution linear resolution 7.2V 850mah LiPoly Battery 18F4525 PIC processor

23 Using Computational Design tools for path planning Siddharth Sanan

24 Platform for Implementation Scout Robot in the REL lab Sensors: Ultrasonic range sensors Wheel Encoders Sonar range sensor output

25 Data from ultrasonic range sensors Static Environment Dynamic environement

26 Experiments on position data from robot How do we know its improving the state estimate? - Make the robot run in a loop Sensor data : [X, Y, θ] T Integrated encoder values State estimated : [X, Y, θ] T using linear kalman filter

27 Topology Optimization for Path generation Initial exercise in generating paths in free space Goal Start Path Found Objective function: 1 min SE = U T KU x 2 (x is a vector containing the thickness of the elements) Applying a force in the direction from the goal to the start we start the optimization Starting from the goal node a connection is made to the next node through the element with the greatest thickness

28 Even in free space there seem to be some issues with the current objective function We do get paths but not necessarily of optimal length, particularly at nodes which are not connected along a single line Goal Start Path Found

29 Future Directions Implement other objective functions Include obstacles Implement the paths on the scout robot for an apriori known map Thank you

30 Physical Construction Nearly complete Missing wheel encoder mounts Need separate left/right Microprocessor/Circuit complete except for sensor connections

31 Software Design

32 Software Design Varied Duty Cycle PWM for Servo Control 4bit Parallel Bus for Character LCD Distance Calculation Based on Speed of Sound Encoder Update

33 Probability Component? Difference between exponential/linear/quadratic dropoff and probabilistic effect? Difference between additive potential vectors and combined view?

34 Other Issues Dead Reckoning Drift Local Minima