# 4zhou 舵机

4zhou 舵机

#include "math.h"#include int main(){        float a1,a2,a3,a4;                  //a1为底部圆台高度 剩下三个为三个机械臂长度     float j1,j4,j2,j3;                      //四个姿态角    float L,H,P;                 //L =a2*sin(j2) + a3*sin(j2 + j3);H = a2*cos(j2) + a3*cos(j2 + j3); P为底部圆盘半径R    float j_all;                                 //j2,j3,j4之和    float len,high;                       //总长度,总高度    float Cosj3,Sinj3;                   //用来存储cosj3,sinj3数值    float Cosj2,Sinj2;    float K1,K2;    float X,Y,Z;                 //输入 （X,Y,Z）坐标    int i;    float n,m,q;    n = 0;    m = 0;    q = 0;    //目标点坐标（X，Y，Z）    X = 0;    Y = 18;    Z = 0;    P = 14;     //底部圆盘半径    a1 = 12;    //底部圆盘高度                    a2 = 12;    //机械臂长度    a3 = 12;    a4 = 12;        if (X == 0)         j1=90;    else         j1 = atan((Y+P)/X)*(57.3);    for(i=0;i180;i++)    {            j_all = 3.1415927*i/180;        len = sqrt((Y+P)*(Y+P)+X*X);        high = Z;                    L = len    - a4*sin(j_all);        H = high - a4*cos(j_all) - a1;                Cosj3 = ((L*L)+(H*H)-((a2)*(a2))-((a3)*(a3)))/(2*(a2)*(a3));        Sinj3 = (sqrt(1-(Cosj3)*(Cosj3)));                j3 = atan((Sinj3)/(Cosj3))*(57.3);                K2 = a3*sin(j3/57.3);        K1 = a2+a3*cos(j3/57.3);                Cosj2 = (K2*L+K1*H)/(K1*K1+K2*K2);        Sinj2 = (sqrt(1-(Cosj2)*(Cosj2)));                j2 = atan((Sinj2)/(Cosj2))*57.3;        j4 = j_all*57.3- j2 - j3;                if(j2>=0&&j3>=0&&j4>=-90&&j2180&&j3180&&j490)        {            n=n+1;        }    }           for(i=0;i180;i++)    {        j_all = 3.1415927*i/180;                len = sqrt((Y+P)*(Y+P)+X*X);        high = Z;        L = len    - a4*sin(j_all);        H = high - a4*cos(j_all) - a1;                Cosj3 = ((L*L)+(H*H)-((a2)*(a2))-((a3)*(a3)))/(2*(a2)*(a3));        Sinj3 = (sqrt(1-(Cosj3)*(Cosj3)));                j3 = atan((Sinj3)/(Cosj3))*(57.3);                K2 = a3*sin(j3/57.3);        K1 = a2+a3*cos(j3/57.3);                Cosj2 = (K2*L+K1*H)/(K1*K1+K2*K2);        Sinj2 = (sqrt(1-(Cosj2)*(Cosj2)));                j2 = atan((Sinj2)/(Cosj2))*57.3;        j4 = j_all*57.3- j2 - j3;                if(j2>=0&&j3>=0&&j4>=-90&&j2180&&j3180&&j490)        {            m=m+1;            if(m==n/2||m==(n+1)/2)            {                    break;            }        }    }       printf("j1:%f,j2:%f\nj3:%f,j4:%f\n",j1,j2,j3,j4);}


• 收藏
• 评论
• *举报

Original: https://blog.51cto.com/u_1355431/5626447
Author: XGLIYOUQUAN
Title: 4zhou 舵机

(0)

### 大家都在看

• #### 【论文笔记(3)】Attention Is All You Need

目录 Ⅰ 论文信息 Ⅱ 论文框架 * 1 Introdcution 2 Background 3 Model Architecture – 3.1 Encoder an…

大数据 2023年5月28日
0179
• #### 一站式元数据治理平台——Datahub入门宝典

大数据 2023年6月2日
0146
• #### Js箭头函数

Js箭头函数 箭头函数是​ &#x200B;ES6&#x200B;​新增的语法，提供了一种更加简洁的函数书写方式，类似于匿名函数，并且简化了函数定义。 完整写法 完…

大数据 2023年5月26日
0146
• #### Spring Boot fastJSON的使用

springBoot，默认使用的json解析框架是Jackson。 虽然jackson能够满足json的解析，如果想使用熟悉的alibaba的fastjon,我们只需要在pom文件…

大数据 2023年5月26日
0161
• #### 《Streaming Systems》第二章: 数据处理中的 What, Where, When, How

本章中，我们将通过对 What， Where， When， How 这 4 个问题的回答，逐步揭开流处理过程的全貌。 What：计算什么结果？ 也就是我们进行数据处理的目的，答案是…

大数据 2023年6月3日
0223
• #### 亲测！超好用 Hive 内置的 json 解析函数

背景 在大数据 ETL(Extract-Transfer-Load) 过程中，经常需要从不同的数据源来提取数据进行加工处理，比较常见的是从 Mysql 数据库来提取数据，而 Mys…

大数据 2023年11月12日
0144
• #### 【网络安全】基于centos7搭建discuz+redis服务

大数据 2023年11月13日
0125
• #### alpakka-kafka(7)-kafka应用案例，消费模式

上篇描述的kafka案例是个库存管理平台。是一个公共服务平台，为其它软件模块或第三方软件提供库存状态管理服务。当然，平台管理的目标必须是共享的，即库存是作为公共资源开放的。这个库存…

大数据 2023年5月28日
0189
• #### winform中使用SqlSugar和SQLite

winform虽然是老古董了，但是在开发桌面方面，还是得心应手的，比如开发一个小工具，小demo之类的。接下来，我们使用SqlSugar和SQLite数据库，在winform中运用…

大数据 2023年11月10日
0126
• #### [hive]维度模型分类:星型模型,雪花模型,星座模型|范式

大数据 2023年11月13日
0117
• #### docker中nsenter使用介绍

示例： 可以用curl命令试试能不能curl通其他应用： docker隔离应用应用涉及到的六大名称空间 1、pid 命名空间(进程ID) 不同用户的进程就是通过 pid 命名空间隔…

大数据 2023年5月28日
0127
• #### 内容分发网络CDN

一、CDN是什么？ CDN的全称是Content Delivery Network，即 内容分发网络。其目的是通过在现有的Internet中增加一层新的CACHE(缓存)层， 将网…

大数据 2023年5月27日
0158
• #### 常用的linux命令

1.cd 命令 cd命令用于切换工作目录，格式 cd [目录] cd /etc 切换到etc目录 cd – 切换到上次访问的目录 cd .. 切换到上一级目录 2.pw…

大数据 2023年6月3日
0194
• #### 【云原生】Hadoop on k8s 环境部署

一、概述 二、开始部署 1）添加源 2）构建镜像 Dockerfile 3）修改配置 4）开始安装 5）测试验证 6）卸载 一、概述 Hadoop是Apache软件基金会下一个开源…

大数据 2023年6月3日
0204