Force Vector Diagrams for an Omni-directional Mobile Robot

In this post, we will take a look out how to draw the force vector diagrams for an omni-directional mobile robot with Mecanum wheels. But before we do that, let’s take a look at a few real-world applications of these vehicles.

Real-World Applications

The following are some common real-world applications for Mecanum-wheeled robots:

  • Industrial forklifts: Moving long loads sideways through narrow aisles and doors.
  • Military: Rescue missions and hazardous environment exploration in tight spaces.
  • Medical: Powered wheelchairs that can maneuver in congested areas.
  • Aviation: Transport of helicopters or large pieces of aircraft

Below is a video of Mecanum-wheeled robots helping to move a piece of a passenger train.

Here is a Mecanum-wheeled robot transporting a helicopter.

Here is a sports car design that uses Mecanum wheels. Makes parallel parking a breeze!

Force Vector Diagrams

The robot schematic diagram below consists of four Mecanum wheels. Each wheel is driven by a motor and contains a set of passive rubber cylinders that are oriented at an angle of 45° to the axis of rotation of the wheel (the axis of rotation of the wheel is the imaginary line that goes through the center of the wheel).

1-mecanum-omnidirectional-robotJPG

The 45° orientation of the rollers is what gives the robot the ability to move in directions other than just forwards and backwards.

Another thing to note is that the rubber rollers of the robot are oriented as an ‘X’ (i.e. the red line below). This X configuration enables the Mecanum-wheeled robot to be able to move in any direction (I’ll show why this is the case in the force/rotation diagrams).

The rollers could also be oriented as an ‘O’ as seen from the top, but in this case, we will assume an X configuration.

2-mecanum-omnidirectional-robotJPG

Before I draw the force/rotation diagrams that cause the different directions of motion of the robot, let’s take a look at the concept of friction because it plays an important role in how the Mecanum wheels do what they do.

Below we have a person trying to push a box across a floor.

The person exerts a pushing force on the box. As the box moves to the right, the surface of the floor exerts a frictional force that acts in the opposite direction of the motion of the box. The person must make sure he pushes hard enough on the box to overcome that frictional force; otherwise, the box won’t move.

3-pushing-forceJPG

Similarly, in the case of the omni-directional Mecanum-wheeled robot, as the wheels rotate, each rubber roller on each wheel makes contact with the surface of the ground at an angle of 45° to the axis of rotation of the wheel.

At the moment each rubber roller makes contact with the ground, the surface of the ground exerts a frictional force that acts in the opposite direction of the force exerted on the ground surface by the rubber roller. There are four frictional forces that act on the robot simultaneously (one for each wheel). It is these forces that cause the robot to move.

In what direction does the robot move? The direction the robot moves is determined by the magnitude and direction of each of the four frictional forces.

Below are the vehicle diagrams (as shown from above the robot) that show how all of this works. The diagrams show how each wheel must move, both direction and angular rate (long vector for high angular rate, short vector for small), so that the indicated motion results. The diagrams also show which way force is applied on the robot when the wheels rotate along the surface of the ground, with the key point being that the sum of the four force vectors (i.e. resultant force) equals the direction of motion of the reference point (which is located in the center of the robot).

  • The red arrows show the magnitude and direction of the rotation of the wheels.
  • The black and orange arrows show the frictional force vectors that act when the rubber roller makes contact with the ground surface. Although these vectors are shown above the robot, they act underneath the robot. They are the frictional forces that act on each rubber roller when it touches the ground surface.
  • The blue arrow shows the motion of the vehicle reference point.
4-linear-forwardJPG

Now, we add up the force vectors on the front and rear of the robot to calculate the resultant force (i.e. motion of the robot/vehicle reference point).

5-resultant-forcesJPG

Using the head-to-tail method to add the force vectors (black and orange arrows above), we see that the x-components of these force vectors on both the front and rear of the vehicle cancel out, so all that is left are the y-components. It is this net, resultant force in the positive y-direction, which results in straight-ahead, forward motion of the robot (i.e. vehicle reference point).

6-linear-reverseJPG

Now, we add up the force vectors on the front and rear of the robot to calculate the resultant force (i.e. motion of the robot/vehicle reference point).

7-resultant-forcesJPG

Similar to the linear forward case, the x-components of the force vectors on both the front and rear of the vehicle cancel out, so all that is left are the y-components. The net force is in the negative y-direction, causing the robot (i.e. vehicle reference point) to move in reverse.

8-linear-leftJPG

Now, we add up the force vectors on the front and rear of the robot to calculate the resultant force (i.e. motion of the robot/vehicle reference point).

9-resultant-forcesJPG

Using the head-to-tail method to add the force vectors (black and orange arrows above), we see that the y-components of these force vectors on both the front and rear of the vehicle cancel out, so all that is left are the x-components. It is this net, resultant force in the negative x-direction, which causes the robot to move linearly to the left.

10-linear-to-rightJPG

Now, we add up the force vectors on the front and rear of the robot to calculate the resultant force (i.e. motion of the robot/vehicle reference point).

11-resultant-forcesJPG

Using the head-to-tail method to add the force vectors (black and orange arrows above), we see that the y-components of these force vectors on both the front and rear of the vehicle cancel out, so all that is left are the x-components. It is this net, resultant force in the positive x-direction which causes the robot to move in a sideways direction to the right.

Finally, here are the force vector diagrams for when the robot spins in-place, either to the left or to the right.

12-pivot-leftJPG
13-pivot-rightJPG

How to Write a Business Plan for a Technology Project

Why Technology Projects Need Business Plans

Having worked with hundreds of early-stage companies as CFO of the first technology startup accelerator in Brazil, I’ve found that one of the most common reasons a business fails is because the founders build things that no one wants. 

A lot of this failure happens because founders — who often have engineering backgrounds — focus so heavily on the shiny, new technology they’ve developed that they overlook the fact that businesses exist to make money by satisfying human desires.

  • A restaurant makes money by satisfying people’s need to eat food. 
  • A software company makes money by satisfying people’s desire to get more things done in a shorter amount of time.
  • A real estate firm makes money by satisfying people’s desire for shelter.
  • A lemonade stand makes money by quenching people’s thirst.

Too many companies create solutions without properly identifying the problem. This happens all the time, especially in robotics.

Remember ASIMO, the cute humanoid robot that Honda spent decades developing? It’s a perfect example of engineers creating a solution without a problem. It wasn’t financially viable, and Honda ceased commercial development of it in 2018.

honda-asimo

The market wants its problems solved, its needs met, and its desires satisfied. It doesn’t care about how much effort you put into building your technology, no matter how awesome it is. 

The best way to make money in the technology business is to take a human desire and use modern technology to make it faster and simpler to satisfy that desire. Start with the customer’s desire and work backwards to the technology.

Solve a big old problem with a unique solution.

Whether you plan to start a small robotics startup or you work for a Fortune 500 company as a machine learning engineer, it’s imperative that you keep the big picture in mind of why a business exists. You’re going to be spending countless hours working on some product, so make sure you:

  • Build things others want. 
  • Build something that has practical, real-world commercial value. 
  • Generate a return on your time and money. 

Life is too short to waste on projects that aren’t worthwhile. 

Millions of dollars and developer hours are wasted each year on products that should never have been built. In order to survive, a company has to make sure it uses its limited time and financial resources efficiently and intelligently. This is especially true in startups where money and time are so often scarce.

Before you begin investing your time and money on developing a product, take a day or two to write up a business plan. As I’ll show you below, it doesn’t need to be anything elaborate. You can put everything on just a single page. 

For example, Sequoia Capital, the early investors of companies such as Apple, Google, LinkedIn, and WhatsApp, has a one-page business plan template that they recommend to founders interested in pitching them for millions of dollars in funding.

Below is the 12-point business plan template I recommend you fill in before you write the first line of code for your next project. Make sure you spend a lot of time on the two most important slides: the problem and the solution. If you get these two slides right, everything else will take care of itself.

Sample Business Plan: Autonomous Strawberry-Picking Robot

strawberry-picking

1. Purpose 

We developed [product] that makes it easier and faster for [target market] to [human desire…preferably one that has been around for a long time].

Example

  • We developed a self-driving strawberry-picking robot that makes it easier and faster for California strawberry farmers to harvest strawberries.

2. Problem 

  • Describe the pain of the customer. 
  • How does the customer address this issue today?

Example

  • California farmers have been unable to find enough workers to harvest their fruits and vegetables, resulting in millions of dollars’ worth of produce rotting in the fields. 
  • Farmers have hired recruiters, raised wages, increased mechanization, and adjusted cultivation practices, yet they still face millions of dollars in crop losses each year (Source: California Farm Bureau Federation).

This video below shows several interviews with farmers who are having trouble finding workers to pick strawberries.

3. Solution 

What is the solution, and how does it make it easier and faster to satisfy the customer’s desire?

Example

  • We developed an autonomous strawberry-picking robot for farmers that is 8x more efficient than humans and can work 24 hours a day, 7 days a week.

4. Product Demo 

  • How does the product work? 
  • Provide use cases.

Example

  • Using the latest advances in computer vision and deep learning technology, the self-driving robot can pick strawberries without bruising them and detect ripeness better than humans.
  • Farmer Joe lost 60% of his crop last year because he was unable to find enough workers. Using the strawberry-picking robot, he can harvest his crop 24/7, while requiring up to 70% fewer seasonal workers.

5. Why Now 

What recent trend makes this product feasible?

Example

  • Computer vision and computer processing power have matured to the point where an autonomous strawberry detection and picking system is feasible.

6. Market Size 

Who does the product cater to, and how big is that market?

Example

7. Competition and Alternatives 

  • Who is the competition?
  • What are the alternatives to using your product?

Examples

  • ABC and XYZ are companies that are in this space.
  • Farmers have tried a number of tactics, such as hiring recruiters, raising wages, increasing mechanization, and adjusting cultivation practices.

8. Competitive Advantage 

What about your solution can’t be easily copied or bought?

Example

  • It’s hard to find someone with more integrated knowledge of both robotics and entrepreneurship to lead the design, development, and deployment of a financially viable robotics product.
  • Existing customers and switching costs.

9. Business Model

  • How will you make money? 
  • Do you have any traction?

Example

  • Subscription (i.e. robotics-as-a-service (RaaS))
  • 15 existing customers, each paying a monthly fee of $2,000.

10. Marketing Plan

How will you acquire new customers?

Example

  • Trade shows
  • Door-to-door sales

11. Team

Who are you, and what are your qualifications?

Example

  • Addison Sears-Collins: A roboticist with over 15 years of experience across a range of industries who has founded several successful technology startups.

12. Financials and Use of Funds

What are your financial projections?

Example

  • Present Value of Cash Inflow = $20M
  • Present Value of Cash Outflow = $5M
  • Net Present Value = US$15M
  • Return of Investment = 300%
  • We will use the funds to hire robotics developers and researchers.

Remember Why You’re Doing What You’re Doing

Being able to clearly articulate why a particular product could contribute to business success is a rare skill among engineers. Having that entrepreneurial mindset will almost certainly separate you from the pack.

How to Describe the Rotation of a Robot in 3D

Before we get into how to describe the rotation of a robot in three dimensions, it is important you understand how to describe the rotation of a robot in two dimensions.

In my previous post, we learned how to calculate the coordinates of a point (or vector) in the 2D global reference frame given the coordinates of that point (or magnitude and direction of that vector) in the 2D robot (local) reference frame (i.e. the rotated coordinate system).

13-robot-coordinate-axes

Here is the equation we use to convert a point in the 2D local reference frame to a point in the 2D global reference frame (If you don’t know how to multiply matrices together, there are a bunch of videos on YouTube that walk through the process):

19-local-to-global-matrix-form

Here is the equation we use to convert velocity in the 2D local reference frame to velocity in the 2D global reference frame:

17-system-of-equations

The thing that makes all this possible is the two-dimensional rotation matrix:

18-rotation-matrix

To describe the rotation of a robot in three dimensions, we need to use the three-dimensional rotation matrix. Let’s explore this now.

mobile_robot_in_3d-1

Table of Contents

Converting a Point (Or Vector) in the 3D Local Reference Frame to a Point in the 3D Global Reference Frame

In two dimensions, the only angle we had to worry about was γ. γ represents the amount of rotation (in degrees or radians) of the robot x-axis from the global x-axis, going in the counterclockwise direction.

12-rotating-robot

γ is often called the yaw angle. It is the angle of rotation about the z-axis.

yaw_pitch_rollJPG

We need to add two more angles:

  • Rotation about the x axis = roll angle = α
  • Rotation about the y-axis = pitch angle = β

If you want to learn more about these angles, check out my post on roll, pitch, and yaw.

So, how do we derive the three-dimensional rotation matrix? What we need to do is calculate the rotation matrix for all rotations a robot can do in a three-dimensional space. Since there are three axes, there are three different rotations we need to account for: rotation about the x-axis, rotation about the y-axis, and rotation about the z-axis.

Return to Table of Contents

Yaw (Rotation about the z-axis)

Let’s start with rotation about the z-axis. Guess what? We already know that rotation matrix.

1-rotation-matrix

This is the two-dimensional case I explained at the beginning of this post. The x and y coordinates of a point in the robot reference frame will change when converted to coordinates in the global reference frame. However, the z coordinate will remain constant.

Here is the rotation matrix that takes care of rotation of a robot in 3D about the global z-axis:

2-yaw

Return to Table of Contents

Pitch (Rotation about the y-axis)

When we rotate a point about the y-axis, the x and z coordinates of the point will change, but the y-coordinate will remain the same. 

Here is the rotation matrix that enables us to convert a point (or vector) in the local reference frame to a point (or vector) in the global reference frame when all we have is rotation of the robot about the global y-axis.

3-pitch

Return to Table of Contents

Roll (Rotation about the x-axis)

When we rotate a point about the x-axis, the y and z coordinates of the point will change, but the x-coordinate will remain the same. 

Here is the rotation matrix that enables us to convert a point (or vector) in the local reference frame to a point (or vector) in the global reference frame when all we have is rotation of the robot about the global x-axis.

4-roll

Return to Table of Contents

Putting It All Together

Ok, so now we need to combine the three matrices above to calculate the full three-dimensional rotation matrix.

5-full-3d-rotation-matrix
6-3d-rotation-matrix-derivation
7-3d-rotation-matrix

Three-Dimensional Rotation Matrix in Python Code

Here is a NumPy-based method that converts angles into a 3×3 rotation matrix like the one above. You can use this method in whatever code you want to write.

import numpy as np # NumPy library

def euler_rotation_matrix(alpha,beta,gamma):
    """
    Generate a full three-dimensional rotation matrix from euler angles

    Input
    :param alpha: The roll angle (radians) - Rotation around the x-axis
    :param beta: The pitch angle (radians) - Rotation around the y-axis
    :param alpha: The yaw angle (radians) - Rotation around the z-axis

    Output
    :return: A 3x3 element matix containing the rotation matrix. 
             This rotation matrix converts a point in the local reference 
             frame to a point in the global reference frame.

    """
    # First row of the rotation matrix
    r00 = np.cos(gamma) * np.cos(beta)
    r01 = np.cos(gamma) * np.sin(beta) * np.sin(alpha) - np.sin(gamma) * np.cos(alpha)
    r02 = np.cos(gamma) * np.sin(beta) * np.cos(alpha) + np.sin(gamma) * np.sin(alpha)
    
    # Second row of the rotation matrix
    r10 = np.sin(gamma) * np.cos(beta)
    r11 = np.sin(gamma) * np.sin(beta) * np.sin(alpha) + np.cos(gamma) * np.cos(alpha)
    r12 = np.sin(gamma) * np.sin(beta) * np.cos(alpha) - np.cos(gamma) * np.sin(alpha)
	
    # Third row of the rotation matrix
    r20 = -np.sin(beta)
    r21 = np.cos(beta) * np.sin(alpha)
    r22 = np.cos(beta) * np.cos(alpha)
	
    # 3x3 rotation matrix
    rot_matrix = np.array([[r00, r01, r02],
                           [r10, r11, r12],
                           [r20, r21, r22]])
						   
    return rot_matrix

def rotate(p1,alpha,beta,gamma):
    """
    Rotates a point p1 in 3D space in the local reference frame to 
    a point p2 in the global reference frame.

    Input
    :param p1: A 3 element array containing the position of a point in the 
              local reference frame (xL,yL,zL) 
    :param alpha: The roll angle (radians) - Rotation around the x-axis
    :param beta: The pitch angle (radians) - Rotation around the y-axis
    :param alpha: The yaw angle (radians) - Rotation around the z-axis

    Output
    :return: p2: A 3 element array containing the position of a point in the 
             global reference frame (xG,yG,zG)

    """
    p2 = euler_rotation_matrix(alpha, beta, gamma) @ p1
    return p2

def main():

    # Point that we want to rotate from local frame to global frame
    p1 = np.array([5,6,7])
    
    # Rotation angles
    alpha = (30/180.0)*np.pi
    beta =  (40/180.0)*np.pi
    gamma = (70/180.0)*np.pi

    print(f'local coordinates p1: {p1}')
    print(f'Rotated by Roll {alpha}, Pitch {beta}, Yaw: {gamma}')
    p2 = rotate(p1,alpha,beta,gamma)

    print(f'global coordinates p2:{p2}')

if __name__ == '__main__':
    main()

Return to Table of Contents

Example Calculation

Let’s say that we have a point P2 (x,y,z) in the local reference frame that has coordinates (5,-2,7). It is rotated the following angles:

  • Yaw = 45°
  • Pitch = 25°
  • Roll = 52°

What is the full three-dimensional rotation matrix?

Remember our equation for the full three-dimensional rotation matrix.

7-3d-rotation-matrix-1

We plug the numbers in the problem statement into this equation above.

1
2
3-calculated-rotation-matrix

What are the coordinates of point P1 (x,y,z), which is the point P2 in terms of the global reference frame?

To get the coordinates of point P1, we need to multiply P2 by the rotation matrix we found above.

4

You should get the numbers in yellow.

5-new-coordinates

Return to Table of Contents

Converting a Point (Or Vector) in the 3D Global Reference Frame to a Point in the 3D Local Reference Frame

Below we are going to derive the equation that will enable you to convert a point (or vector) in the 3D global reference frame to a point (or vector) in the 3D local reference frame. In other words, we are going to calculate the three-dimensional inverse rotation matrix.

If you remember, when we derived the three-dimensional rotation matrix earlier in this post, we started out with this equation.

5-full-3d-rotation-matrix-1

You’ll notice that the first operation performed on a point in the local frame is to account for rotation about the x-axis (i.e. roll). Then we do pitch (rotation about the y-axis), and then we do yaw (rotation about the z-axis). This sequence of operations enables us to convert any point (or vector) in the 3D local reference frame to a point (or vector) in the 3D global reference frame. 

To calculate the inverse three-dimensional rotation matrix, we need to find the inverse of each of the three matrices and then perform the operations in reverse order. Let’s walk through this together.

First, we need to calculate the inverse for each of the three matrices. The inverse of a rotation matrix R is equal to the rotation matrix’s transpose (RT = R-1), where T means “transpose” and -1 means “inverse”. If you don’t know how to take the transpose of a 3×3 matrix, take a look at this article.

And since the last operation performed is yaw, we need to take its transpose, then take the transpose of the pitch matrix, and then take the transpose of the roll matrix.

Here are the steps of the matrix multiplication:

8-inverse-rotation-matrix
9-inverse-rotation-matrix
10-inverse-rotation-matrix

And there you have it. This matrix below is the full three-dimensional inverse rotation matrix. Use it when you want to convert a point (or vector) in the 3D global reference frame to a point (or vector) in the 3D local reference frame:

11-full-inverse-3d-rotation-matrix

Three-Dimensional Inverse Rotation Matrix in Python Code

Here is a NumPy-based method that converts angles into a 3×3 inverse rotation matrix like the one above. You can use this method in whatever code you want to write.

import numpy as np

def euler_rotation_matrix(alpha,beta,gamma):
    """
    Generate a full three-dimensional rotation matrix from euler angles

    Input
    :param alpha: The roll angle (radians) - Rotation around the x-axis
    :param beta: The pitch angle (radians) - Rotation around the y-axis
    :param alpha: The yaw angle (radians) - Rotation around the z-axis

    Output
    :return: A 3x3 element matix containing the rotation matrix. 
             This rotation matrix converts a point in the local reference 
             frame to a point in the global reference frame.

    """
    # First row of the rotation matrix
    r00 = np.cos(gamma) * np.cos(beta)
    r01 = np.cos(gamma) * np.sin(beta) * np.sin(alpha) - np.sin(gamma) * np.cos(alpha)
    r02 = np.cos(gamma) * np.sin(beta) * np.cos(alpha) + np.sin(gamma) * np.sin(alpha)
    
    # Second row of the rotation matrix
    r10 = np.sin(gamma) * np.cos(beta)
    r11 = np.sin(gamma) * np.sin(beta) * np.sin(alpha) + np.cos(gamma) * np.cos(alpha)
    r12 = np.sin(gamma) * np.sin(beta) * np.cos(alpha) - np.cos(gamma) * np.sin(alpha)
	
    # Third row of the rotation matrix
    r20 = -np.sin(beta)
    r21 = np.cos(beta) * np.sin(alpha)
    r22 = np.cos(beta) * np.cos(alpha)
	
    # 3x3 rotation matrix
    rot_matrix = np.array([[r00, r01, r02],
                           [r10, r11, r12],
                           [r20, r21, r22]])
						   
    return rot_matrix

def rotate(p1,alpha,beta,gamma):
    """
    Rotates a point p1 in 3D space in the local reference frame to 
    a point p2 in the global reference frame.

    Input
    :param p1: A 3 element array containing the position of a point in the 
              local reference frame (xL,yL,zL) 
    :param alpha: The roll angle (radians) - Rotation around the x-axis
    :param beta: The pitch angle (radians) - Rotation around the y-axis
    :param alpha: The yaw angle (radians) - Rotation around the z-axis

    Output
    :return: p2: A 3 element array containing the position of a point in the 
             global reference frame (xG,yG,zG)

    """
    p2 = euler_rotation_matrix(alpha, beta, gamma) @ p1
    return p2

def inverse_rotation(p2,alpha,beta,gamma):  
    """
    Inverse rotation from a point p2 in global 3D reference frame 
    to a point p1 in the local (robot) reference frame.

    Input
    :param p2: A 3 element array containing the position of a point in the 
               global reference frame (xG,yG,zG)
    :param alpha: The roll angle (radians) - Rotation around the x-axis
    :param beta: The pitch angle (radians) - Rotation around the y-axis
    :param alpha: The yaw angle (radians) - Rotation around the z-axis

    Output
    :return: A 3 element array containing the position of a point in the 
             local reference frame (xL,yL,zL) 

    """
    # First row of the inverse rotation matrix
    r00 = np.cos(gamma) * np.cos(beta)
    r01 = np.sin(gamma) * np.cos(beta)
    r02 = -np.sin(beta)
	
    # Second row of the inverse rotation matrix	
    r10 = np.cos(gamma) * np.sin(beta) * np.sin(alpha) - np.sin(gamma) * np.cos(alpha)
    r11 = np.sin(gamma) * np.sin(beta) * np.sin(alpha) + np.cos(gamma) * np.cos(alpha)	
    r12 = np.cos(beta) * np.sin(alpha)	
	
    # Third row of the inverse rotation matrix	
    r20 = np.cos(gamma) * np.sin(beta) * np.cos(alpha) + np.sin(gamma) * np.sin(alpha)
    r21 = np.sin(gamma) * np.sin(beta) * np.cos(alpha) - np.cos(gamma) * np.sin(alpha)
    r22 = np.cos(beta) * np.cos(alpha)
	
    # 3x3 inverse rotation matrix
    inv_rot_matrix = np.array([[r00, r01, r02],
                               [r10, r11, r12],
                               [r20, r21, r22]]) 
						   
    return inv_rot_matrix @ p2

def main():

    # Point that we want to rotate from local frame to global frame
    p1 = np.array([5,6,7])
    
    # Rotation angles
    alpha = (30/180.0)*np.pi
    beta =  (40/180.0)*np.pi
    gamma = (70/180.0)*np.pi

    print(f'local coordinates p1: {p1}')
    print(f'Rotated by Roll {alpha}, Pitch {beta}, Yaw: {gamma}')
    p2 = rotate(p1,alpha,beta,gamma)

    print(f'global coordinates p2:{p2}')
    p1_ = inverse_rotation(p2,alpha,beta,gamma)

    print(f'inverse rotation back into local frame p1:{p1_}')

if __name__ == '__main__':
    main()

Return to Table of Contents