Write a program to simulate the motion of the robot using

Question

E28: Mobile Robotics - Fall 2015 - HOMEWORK 1

1. Orthogonal transformations

Recall that an n x n matrix A is an orthogonal transformation if any of these four equivalent criteria are met:

• A has n mutually perpendicular, unit length rows or columns
• the rows or columns of A form an orthonormal basis for Rⁿ
• AA^T = AT^A = I
• A^-1 = AT

Also recall that orthogonal transformations preserve inner products. For any orthogonal transformation A and any two vectors x and y,

(Ax) · (Ay) = x · y

Using the definition and property above, prove the following:

a. The product of any two orthogonal transformations A and B is itself an orthogonal transformation.

b. For any orthogonal transformation A and any vector x, ||Ax|| = ||x||

2. Rigid transformations

a. As we said in class, a rigid transformation in 2D parameterized by a rotation matrix R and a translation vector t can be represented by the 3x3 matrix

Show that the product of two such matrices M₂ and M₁ parameterized by R₂, t₂, R₁, and t₁, results in a matrix which is equivalent to the composition of the rigid transformations that we discussed in class.

b. A pair of transformations T₁ and T₂ is said to obey the commutative property if

T₂(T₁(p)) = T₁(T₂(p))

For each of the following, show that the pair of transformations commutes, or provide a counterexample indicating that they do not.

• any two rotations in R²
• any two translations in Rⁿ
• any two rigid transformations in R²
• any two rotations in R³

3. Simulating robot motion

A differential drive robot has a wheel radius of 0.05 m, and the wheel centers are each a distance 0.05 m from the centerline. Starting out at (x_w = 0, y_w = 0, θ = 0), the robot's wheels undergo the following velocities:

• v_L = 2, v_R = 1.5 for 3 seconds
• v_L = 1.0, v_R = -1.0 for 2 seconds
• v_L = 0.5, v_R = 2.5 for 2 seconds
• v_L = -1.5, v_R = 1.0 for 3 seconds

Write a program to simulate the motion of the robot using the equations from class. You should assume that the robot changes its wheel velocities instantaneously.

a. Run your program three times, with step sizes of ?t = 0.25 s, 0.125 s, and 0.0625 s.

b. Create an x/y plot of all three robot paths on a single graph. Use different colors or line styles to distinguish the paths, and make sure to use an equal aspect ratio when plotting (axis equal, in MATLAB parlance).

c. Note what happens as the timestamp gets smaller. Are there systematic errors caused by large step sizes, or is the error more or less random? Write your answers on the same page as your plot printout.

You can write your program in any programming language you want. Be sure to turn in printouts of both your code and your graph.