360度虚拟摇杆控制机器人前进后退转弯（一）

最新推荐文章于 2023-12-23 23:42:15 发布
最新推荐文章于 2023-12-23 23:42:15 发布
阅读量2.4k 收藏 10
点赞数 2
分类专栏： Android 文章标签： 线性代数 java android
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/wz_1992/article/details/112916149
版权

项目需求

最近做一个项目，要求使用虚拟摇杆控制机器人设备前进后退转弯，整个过程的思路不算复杂，写篇文章记录下大致思路
（1）黄色圆不动时候 小车速度为0
（2）拖动摇杆 拖动距离越大 小车速度越大 距离最大为灰色圆环半径
（3）向正上方拖动时候要求左右轮速度相同 小车前进
（4）向正下方拖动时候要求左右轮速度相同 小车后退
（5）向斜方向拖动时候要求小车向对应方向转弯
（6）速度范围1200~1800

一、360虚拟摇杆的实现

中间黄色圆可以360度移动，最大运动距离为外部灰色圆环半径
在这里插入图片描述

思路

以圆心为坐标系原点 分为四个象限 取两个速度 d/R y/R 为左右轮速度
在第一象限运动 手指由左到右运动 小车则向右转弯 右轮速度减小 即此时右轮速度为小的那个y/R 左轮速度为大的那个 d/R
其他象限同理
R为灰色圆环半径，即运动最大距离
在这里插入图片描述

代码实现：

package com.light.robotproject.views;

import android.annotation.SuppressLint;
import android.content.Context;
import android.graphics.Bitmap;
import android.graphics.BitmapFactory;
import android.graphics.Canvas;
import android.graphics.Color;
import android.graphics.Paint;
import android.graphics.PixelFormat;
import android.graphics.Point;
import android.graphics.PorterDuff.Mode;
import android.graphics.RectF;
import android.util.AttributeSet;
import android.util.Log;
import android.view.MotionEvent;
import android.view.SurfaceHolder;
import android.view.SurfaceHolder.Callback;
import android.view.SurfaceView;

import com.light.robotproject.R;
import com.light.robotproject.utils.MiscUtil;

public class MySurfaceView2 extends SurfaceView implements Callback {

    private SurfaceHolder sfh;
    private Canvas canvas;
    private Paint paint;
    private Context mContext;
    private int coordinate;
    // 固定摇杆背景圆形的半径
    private int RockerCircleR, SmallRockerCircleR;
    // 摇杆的X,Y坐标以及摇杆的半径
    private float SmallRockerCircleX, SmallRockerCircleY;

    private RudderListener listener = null; // 事件回调接口

    public MySurfaceView2(Context context) {
        super(context);
    }

    public MySurfaceView2(Context context, AttributeSet as) {
        super(context, as);
        this.setKeepScreenOn(true);
        this.mContext = context;
        sfh = getHolder();
        sfh.addCallback(this);
        paint = new Paint();
        paint.setColor(Color.GREEN);
        paint.setAntiAlias(true);// 抗锯齿
        setFocusable(true);
        setFocusableInTouchMode(true);
        setZOrderOnTop(true);
        sfh.setFormat(PixelFormat.TRANSPARENT);// 设置背景透明

    }

    public void surfaceCreated(SurfaceHolder holder) {

        // 获得控件最小值
        int little = this.getWidth() < this.getHeight() ? this.getWidth()
                : this.getHeight();
        // 根据屏幕大小绘制
        SmallRockerCircleX = SmallRockerCircleY = coordinate = little / 2;
        // 固定摇杆背景圆形的半径
        RockerCircleR = (int) (little * 0.35) - 20;
        // 摇杆的半径
        SmallRockerCircleR = (int) (little * 0.15);
        draw();
    }

    /***
     * 得到两点之间的弧度
     */
    public double getRad(float px1, float py1, float px2, float py2) {
        // 得到两点X的距离
        float x = px2 - px1;
        // 得到两点Y的距离
        float y = py1 - py2;
        // 算出斜边长
        float xie = (float) Math.sqrt(Math.pow(x, 2) + Math.pow(y, 2));
        // 得到这个角度的余弦值（通过三角函数中的定理 ：邻边/斜边=角度余弦值）
        float cosAngle = x / xie;
        // 通过反余弦定理获取到其角度的弧度
        float rad = (float) Math.acos(cosAngle);
        // 注意：当触屏的位置Y坐标<摇杆的Y坐标我们要取反值-0~-180
        if (py2 < py1) {
            rad = -rad;
        }
        return rad;
    }

    public double getAngle(float px1, float py1, float px2, float py2) {
        double angle = Math.toDegrees(Math.atan2(py2 - py1, px2 - px1));
        Log.i("tempRad角度==", angle + "");
        return angle;

    }

    public double getDistance(float px1, float py1, float px2, float py2) {
        // 计算两点间距离公式
        double juli = Math.sqrt(Math.abs((px2 - px1) * (px2 - px1)) + (py2 - py1) * (py2 - py1));
        System.out.println("两点间的距离是:" + juli);
        if (juli < 0) {
            juli = -juli;
        }
        return juli;
    }

    @SuppressLint("ClickableViewAccessibility")
    @Override
    public boolean onTouchEvent(MotionEvent event) {
        // 得到摇杆与触屏点所形成的角度
        double tempRad = getRad(coordinate, coordinate, event.getX(),
                event.getY());
        getAngle(coordinate, coordinate, event.getX(),
                event.getY());
        if (event.getAction() == MotionEvent.ACTION_DOWN
                || event.getAction() == MotionEvent.ACTION_MOVE) {
            // 当触屏区域不在活动范围内
            if (Math.sqrt(Math.pow((coordinate - (int) event.getX()), 2)
                    + Math.pow((coordinate - (int) event.getY()), 2)) >= RockerCircleR) {
                // 保证内部小圆运动的长度限制
                getXY(coordinate, coordinate, RockerCircleR, tempRad);
            } else {// 如果小球中心点小于活动区域则随着用户触屏点移动即可
                SmallRockerCircleX = (int) event.getX();
                SmallRockerCircleY = (int) event.getY();
            }
        } else if (event.getAction() == MotionEvent.ACTION_UP) {
            // 当释放按键时摇杆要恢复摇杆的位置为初始位置
            SmallRockerCircleX = coordinate;
            SmallRockerCircleY = coordinate;
        }
        draw();
        //摇杆移动半径=圆环半径
        double roundRate = RockerCircleR;//85+15

        //触摸点到圆点的比例
        double ratio = getDistance(coordinate, coordinate, SmallRockerCircleX,
                SmallRockerCircleX) / roundRate;
        //将坐标系旋转
//        Point nowSmall=calcNewPoint(new Point((int) SmallRockerCircleX,(int) SmallRockerCircleY),new Point(coordinate,coordinate),-45);
        Point oldSmall = new Point((int) SmallRockerCircleX, (int) SmallRockerCircleY);
        //将圆点坐标从（150,150）移到中心点（0,0）
//        double x = Math.abs(oldSmall.x) - coordinate;
//        double y = Math.abs(oldSmall.y) - coordinate;
        /**
         * 获得两个速度
         * 一个根据圆心到摇杆半径距离比例来算d/r--为大速度
         * 一个根据y/r来算--为小速度
         */
        double distanceR=getDistance(SmallRockerCircleX,SmallRockerCircleY,coordinate,coordinate)/roundRate;
        double distanceY=Math.abs(coordinate-SmallRockerCircleY)/roundRate;
        Log.i("MySurfaceView2==", "dR==" + getDistance(SmallRockerCircleX,SmallRockerCircleY,coordinate,coordinate) + "   dY==" + (coordinate-SmallRockerCircleY) + "\r\ndistanceR==" + distanceR + "distanceY==" + distanceY);

        if (listener != null) {
            listener.onSteeringWheelChanged(SmallRockerCircleX,
                    SmallRockerCircleY, distanceR, distanceY);
        }

        return true;
    }

    /**
     * @param R       圆周运动的旋转点
     * @param centerX 旋转点X
     * @param centerY 旋转点Y
     * @param rad     旋转的弧度
     */
    public void getXY(float centerX, float centerY, float R, double rad) {
        // 获取圆周运动的X坐标
        SmallRockerCircleX = (float) (R * Math.cos(rad)) + centerX;
        // 获取圆周运动的Y坐标
        SmallRockerCircleY = (float) (R * Math.sin(rad)) + centerY;
        Log.i("MySurfaceView2==getXY", "x==" + SmallRockerCircleX + "y==" + SmallRockerCircleY);
    }

    public void draw() {
        try {
            canvas = sfh.lockCanvas();
            // canvas.drawColor(Color.WHITE);
            canvas.drawColor(Color.TRANSPARENT, Mode.CLEAR);// 清除屏幕
            drawCircle();
            drawRomot();
        } catch (Exception e) {
            // TODO: handle exception
        } finally {
            try {
                if (canvas != null)
                    sfh.unlockCanvasAndPost(canvas);
            } catch (Exception e2) {

            }
        }
    }

    /**
     * 绘制圆环
     */
    public void drawCircle() {
        //绘制圆弧的边界
        RectF mRectF = new RectF();
        mRectF.left = coordinate - RockerCircleR /*- 20*/;
        mRectF.top = coordinate - RockerCircleR /*- 20*/;
        mRectF.right = coordinate + RockerCircleR /*+ 20*/;
        mRectF.bottom = coordinate + RockerCircleR /*+ 20*/;
        Paint ringNormalPaint = new Paint(paint);
        ringNormalPaint.setStyle(Paint.Style.STROKE);
        ringNormalPaint.setStrokeWidth(15);
        ringNormalPaint.setColor(mContext.getResources().getColor(R.color.Color_584832));
        canvas.drawArc(mRectF, 360, 360, false, ringNormalPaint);
    }

    /**
     * 绘制摇杆
     */
    public void drawRomot() {
        paint.setColor(mContext.getResources().getColor(R.color.Color_88FFFF00));
        // 绘制摇杆
        canvas.drawCircle(SmallRockerCircleX, SmallRockerCircleY,
                SmallRockerCircleR + 10, paint);
        paint.setColor(Color.YELLOW);
        // 绘制摇杆
        canvas.drawCircle(SmallRockerCircleX, SmallRockerCircleY,
                SmallRockerCircleR - 5, paint);

    }

    public void surfaceChanged(SurfaceHolder holder, int format, int width,
                               int height) {
    }

    public void surfaceDestroyed(SurfaceHolder holder) {
    }

    // 设置回调接口
    public void setRudderListener(RudderListener rockerListener) {
        listener = rockerListener;
    }

    // 回调接口
    public interface RudderListener {
        void onSteeringWheelChanged(double x, double y, double distanceR, double distanceY);
//        void onSteeringWheelChanged(double angle, double distanceRatio);
    }

    /**
     * 将点围绕圆点旋转45度  使得x=y点为最北点
     * 这样当拉到最上面时候  左右轮速度一样
     *
     * @param p
     * @param pCenter
     * @param angle
     * @return
     */
    private static Point calcNewPoint(Point p, Point pCenter, float angle) {
        // calc arc
        float l = (float) ((angle * Math.PI) / 180);

        //sin/cos value
        float cosv = (float) Math.cos(l);
        float sinv = (float) Math.sin(l);

        // calc new point
        float newX = (float) ((p.x - pCenter.x) * cosv - (p.y - pCenter.y) * sinv + pCenter.x);
        float newY = (float) ((p.x - pCenter.x) * sinv + (p.y - pCenter.y) * cosv + pCenter.y);
        return new Point((int) newX, (int) newY);
    }
}


   <com.light.robotproject.views.MySurfaceView2
            android:id="@+id/remote1"
            android:layout_width="150dp"
            android:layout_height="150dp" />
回调
 remote1.setRudderListener(object : MySurfaceView2.RudderListener {
            override fun onSteeringWheelChanged(
                x: Double,
                y: Double,
                distanceR: Double,
                distanceY: Double
            ) {
                /**
                 * 手指触摸地  x，y
                 * distanceR  触摸点距离圆心distance/灰色圆环半径R
                 * distanceY  触摸点坐标y/灰色圆环半径R
                 * 在最北边时候distanceR=distanceY  即左右轮速度相同  设备向前运动
                 * 根据坐标分为四个象限  根据  x，y和坐标原点的大小  来判断左右转 
                 *  distanceR和distanceY   分别为左右轮速度    具体为哪个速度要根据象限来判断左转右转
                 * 例如左转时候 右轮速度>左轮速度
                 */
                Log.i(
                    "RudderListener==",
                    "x==" + x + "y==" + y + "distanceR==" + distanceR + "distanceY==" + distanceY
                )
                //根据灵敏度算速度
                getSpeed(x, y, distanceR, distanceY)
            }

        })

获取速度

 /**
     * 根据象限区域判断左右轮速度归属
     * 圆心为（150,150）
     */
     var minSpeed=1200
     var maxSpeed=1800
    fun setSpeed(
        x: Double,
        y: Double,
        distanceR: Double,
        distanceY: Double,
        minSpeed: Int,
        maxSpeed: Int
    ) {
        var center = 150  //摇杆中心坐标（150，150）
        var speedBig = getRealSpeed(distanceR, minSpeed, maxSpeed)
        var speedSmall = getRealSpeed(distanceY, minSpeed, maxSpeed)
        if ((x > center && y < center) || (x > center && y > center)) { //第一、四象限方向  右转、右退  左轮>右轮
            ch1Speed = speedBig
            ch2Speed = speedSmall
        } else if ((x < center && y < center) || (x < center && y > center)) {//第二、三象限方向 左前、左退  右轮>左轮
            ch1Speed = speedSmall
            ch2Speed = speedBig
        }
        if (x == 150.0 && y == 150.0) {
            ch1Speed = 0.0
            ch2Speed = 0.0
        }
        Log.i("获取转速==", "左轮ch1Speed==" + ch1Speed + "右轮ch2Speed==" + ch2Speed)
    }

中间踩的坑

刚开始思考这个算法时候觉得很难，我把方向对准在圆上，发现要找规律对我自己这个数学水平来说很难很难，后来在同事的提醒下，将方向转为线性，突然发现茅塞顿开，由此可见处理问题的时候还是不能让自己钻牛角尖，集思广益，自己想不通的东西，别人一句话就搞定了。

文阿花
关注
  • 2
    点赞
  • 踩
  • 10
    收藏
    觉得还不错? 一键收藏
  • 4
    评论
专栏目录
机器人前进后退左转右转
10-18
机器人前进后退左转右转的c语音代码，PWM控制直流电机正反转
android摇杆效果，跟随手指移动的小球，控制小车方向，王者荣耀的方向键
gong0585的专栏
03-17 525
android摇杆效果，跟随手指移动的小球，控制小车方向，王者荣耀的方向键。
采用ESP-NOW实现遥杆控制小车
最新发布
ijij9的博客
12-23 1366
这篇教程会向你展示如何在家中用基础电子零件制作一辆用摇杆控制小车的示例。车子可以通过遥杆来控制，而且不只限于4个方向。这是一个对于初学者来说非常有趣的项目，占用的完成时间不会很多，通过它不仅可以学习到如何搭建车辆，还可以了解电机对车辆工作的作用，以及一些基本的电子知识、编程实践，甚至一些物理知识。本篇文章采用整辆机器人车的电路图如教程所示，没有使用面包板，而是直接使用跳线在组件之间进行连接。建立连接之前，确保将电池的地线连接到马达驱动器和ESP8266的GND。
5.39 综合案例2.0 - STM32蓝牙遥控小车3(摇杆控制)
haas506开发板
04-07 1995
用STM32单片机做了一辆蓝牙控制的麦轮小车，分享一下小车的原理和制作过程。 控制部分分为手机APP，语音模块控制，Haas506开发板三种。 本文介绍Haas506控制的方法以及小车的制作。
stm32智能遥控小车项目(3) --- 遥控器摇杆的使用
m_612651x的博客
09-20 877
stm32 摇杆 ADC
游戏摇杆编程
我想想的博客
05-21 3514
文章目录前言摇杆介绍技术特性源程序获取摇杆功能信息获取摇杆当前状态 前言 基于前面几篇博文的介绍，我们可以进行编程，以获取游戏遥感所传回的数据。 前文回顾： WindowsAPI之joystickapi(游戏摇杆)头文件 Windows API 之joystickapi(游戏摇杆)头文件2 Windows API 之joystickapi(游戏摇杆)头文件3 Windows API 之joystickapi(游戏摇杆)头文件4 本文的编程环境及工具如下： IDE： Visual Studio 2013
第三章、移动机器人控制2
weixin_42957913的博客
05-09 708
一、前进运动控制 前向运动控制，我们指的是定义移动机器人v(t)的平移速度以实现某种控制目标的控制算法。前向运动控制本身不能作为移动机器人的控制策略。 然而，为了达到控制目标，必须控制平移速度。 前进运动控制不可避免地与方向控制相联系。 一个合理的想法是应用与到参考点的距离成比例的控件(xref(t)， yref(t))。 注意，参考位置可以是恒定的，也可以根据参考轨迹改变。公式当然有一些限制，如果到参考点的距离非常大或非常小，则需要进行特殊处理。 非常大： 对最大速度命令引入一些限制。在实践中，这些限制
机器人控制实验（二自由度机器人的位置PD控制）
05-26
机器人控制实验（二自由度机器人的位置PD控制） 本实验的目的是通过 Matlab 语言、Simulink 及 Robot 工具箱，搭建二自由度机器人的几何模型、动力学模型，并构建控制器模型，通过调整控制器参数，对二自由度机器人...
PID_机器人控制_二自由度机器人PID_pid机器人_
10-03
二自由度机器人的pid控制
二自由度机器人的模糊pid控制的simulink仿真+含代码操作演示视频
05-09
二自由度机器人的模糊pid控制的simulink仿真+含代码操作演示视频 运行注意事项：使用matlab2021a版本测试，先运行里面的sim.mdl文件，然后运行MyPlot.m文件，不要直接运行子函数文件。运行时注意matlab左侧的当前...
游戏算法整理（贴图完整版）
01-05
游戏算法整理——前辈曾经贴过，不过部分图没有了，现在补一个完整版。
四自由度串联机器人运动控制系统的二次开发
08-02
随着机器人技术的快速发展,机器人在各个领域中的作用越来越重要。通过对机器人运动控制系统的二次开发可以实现对机器人的远程控制,并在此...本文的研究对象为四自由度串联机器人,研究了其运动控制系统二次开发的问题.
Android 屏幕摇杆控制 蓝牙小车速度及方向 和传感器控制
03-29 1533
以前接手的一个蓝牙项目 不说多，先上控制界面图 本文重点说的是图片左下方的控制摇杆原点的实现 先写摇杆控件 /** * 摇杆控件 */ public class RockerView extends View { private static final String TAG = "RockerView"; private static final int DEFAULT_SIZE = 400; private static final int DEFAULT_RO
ps2摇杆模块控制小车_八个超赞的两轮平衡小车设计，小白最爱
weixin_39891272的博客
10-28 1534
智能车种类众多，其中两轮平衡车特别受到了工程师的喜爱，整理了8个两轮平衡车的资料，一起看看这个小可爱吧。1、基于ARM-STM32的两轮自平衡小车小车直立和方向控制任务都是直接通过控制小车两个电机完成的。假设小车电机可以虚拟地拆解成两个不同功能的驱动电机，它们同轴相连，分别控制小车的直立平衡、左右方向。在实际控制中，是将控制小车直立和方向的控制信号叠加在一起加载电机上，只要电机处于线性状态就可以同...
Android手机游戏摇杆
zpDreamer的博客
04-04 2648
手机游戏摇杆，采用自定义组件
用SurfaceView实现Android游戏摇杆
GitLqr的博客
04-13 1107
这段时间研究自定义控件，遂想起游戏里的摇杆的实现挺有意思，于是来自己写一套熟悉熟悉，关于SurfaceView的特性网上也有很多，故不赘述，反正绘图用起来挺爽就是了，永远的告别了JAVA GUI手动实现双缓冲的时代了…… 1、Rudder类的实现： import com.game.graphics.utils.MathUtils; import android.content.Con
手机游戏绘制触屏虚拟摇杆的几何算法
Ruilin
08-28 2020
几何学的图形计算经常应用到游戏或其它复杂的UI的开发中，下面介绍的是开发游戏中所用到的计算已知直线与圆交点的坐标。·如图，当某个物体活动范围仅限于圆o的区域范围内，可以拖动它移动，即在圆的区域内物体的坐标跟着a移动，而当拖动点a离开圆的区域后，物体只能移动到圆的边界上，并且保持着a与o的直线上，于是便有了以下一道数学题：求线ao与圆o的交点 e(xe,ye)？ 这是一道常见的数学题，但通
[Unity]虚拟摇杆插件摇杆方向锁定只朝一个方向移动
BuladeMian的博客，菜得抠脚，菜得真实
10-13 338
使用虚拟摇杆插件出现了一个 摇杆方向锁定只朝一个方向移动 的BUG。 可能是因为虚拟摇杆所在的父物体的Canvas的所属的层级太复杂。 如果 虚拟摇杆的实体prefab预制体所在的Canvas没有任何父物体，在场景中可以正常使用，虚拟摇杆的脚本都是正常的。 那么就是其虚拟摇杆的实体prefab预制体所在的Canvas的父物体的层级过于复杂，导致的BUG。 尝试减少虚拟摇杆的实体prefab预制体所在的Canvas的 父物体的层级，就可以减少这个bug Hierarchy -S...
虚拟摇杆控制物体移动，解决旋转之后物体依然朝遥杆对应方向移动的问题
css132749的博客
02-28 1311
笔者在使用虚拟摇杆的过程中，不仅需要遥杆控制物体前后左右移动，还用按钮控制物体左右旋转，因为摄像机在物体上，这就产生了一个问题，在旋转之前，物体移动的方向跟视角方向一样，但是一旦开始旋转几次后，物体的移动依然是按着摇杆控制的世界坐标的方向移动，可是由于视角改变，造成摇杆的方向跟物体移动的视角方向不一致。于是笔者就对物体的移动进行了一定的改动，达到了想要的结果。public void Move(Ve...
C语言机器人前进后退代码
04-21
以下是C语言机器人前进后退的代码示例： ```c #define FORWARD 1 #define BACKWARD 2 void moveRobot(int direction) { if(direction == FORWARD) { // 向前移动代码 printf("机器人向前移动\n"); } else if...

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 4
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值