1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101 |
- #include "chan.h"
- #include "log.h"
- #include "mb.h"
- #include "mbctx.h"
- #include "plt.h"
- #include "port.h"
- #define EXPORT_PATH "/sys/class/gpio/export" // export文件路径
- #define UNEXPORT_PATH "/sys/class/gpio/unexport" // unexport文件路径
- #define DIR_OUT "out"
- #define DIR_IN "in"
- #define SA struct sockaddr
- /*
- #define _FC_READ_COILS 0x01
- #define _FC_READ_DISCRETE_INPUTS 0x02
- #define _FC_READ_HOLDING_REGISTERS 0x03
- #define _FC_READ_INPUT_REGISTERS 0x04
- #define _FC_WRITE_SINGLE_COIL 0x05
- #define _FC_WRITE_SINGLE_REGISTER 0x06
- #define _FC_READ_EXCEPTION_STATUS 0x07
- #define _FC_WRITE_MULTIPLE_COILS 0x0F
- #define _FC_WRITE_MULTIPLE_REGISTERS 0x10
- #define _FC_REPORT_SLAVE_ID 0x11
- #define _FC_WRITE_AND_READ_REGISTERS 0x17
- */
- int channbr;
- struct chan_t chan[CHAN_NBR_MAX + 1];
- static struct chanthrd_param_t chanthrd_param[CHAN_NBR_MAX + 1];
- void chan_lock(int idx)
- {
- pthread_mutex_lock(&chan[idx].mutex);
- }
- void chan_unlock(int idx)
- {
- pthread_mutex_unlock(&chan[idx].mutex);
- }
- static void chan_dump(char *buf_dst, unsigned char *buf_src, int len)
- {
- char buf_t[16];
- int i;
- buf_dst[0] = 0;
- for (i = 0; i < len; i++)
- {
- sprintf(buf_t, "%02X ", buf_src[i]);
- strcat(buf_dst, buf_t);
- }
- }
- static int chan_set_baud(int fd, int speed)
- {
- int i;
- int status;
- struct termios Opt;
- int speed_arr[] = {B115200, B57600, B38400, B19200, B9600, B4800, B2400, B1200};
- int name_arr[] = {115200, 57600, 38400, 19200, 9600, 4800, 2400, 1200};
- tcgetattr(fd, &Opt);
- for (i = 0; i < sizeof(speed_arr) / sizeof(int); i++)
- {
- if (speed == name_arr[i])
- {
- tcflush(fd, TCIOFLUSH);
- cfsetispeed(&Opt, speed_arr[i]);
- cfsetospeed(&Opt, speed_arr[i]);
- status = tcsetattr(fd, TCSANOW, &Opt);
- if (status != 0)
- {
- perror("tcsetattr fail\n");
- return -1;
- }
- else
- {
- return 0;
- }
- }
- tcflush(fd, TCIOFLUSH);
- }
- return -1;
- }
- static int chan_set_parity(int fd, int databits, int stopbits, int parity)
- {
- struct termios options;
- if (tcgetattr(fd, &options) != 0)
- {
- perror("SetupSerial 1");
- return -1;
- }
- options.c_cflag &= ~CSIZE;
- switch (databits)
- {
- case 7:
- options.c_cflag |= CS7;
- break;
- case 8:
- options.c_cflag |= CS8;
- break;
- default:
- fprintf(stderr, "Unsupported data size\n");
- return -1;
- }
- switch (parity)
- {
- case 'n':
- case 'N':
- options.c_cflag &= ~PARENB;
- options.c_iflag &= ~INPCK;
- break;
- case 'o':
- case 'O':
- options.c_cflag |= (PARODD | PARENB);
- options.c_iflag |= INPCK;
- break;
- case 'e':
- case 'E':
- options.c_cflag |= PARENB;
- options.c_cflag &= ~PARODD;
- options.c_iflag |= INPCK;
- break;
- case 'S':
- case 's':
- options.c_cflag &= ~PARENB;
- options.c_cflag &= ~CSTOPB;
- break;
- default:
- fprintf(stderr, "Unsupported parity\n");
- return -1;
- }
- switch (stopbits)
- {
- case 1:
- options.c_cflag &= ~CSTOPB;
- break;
- case 2:
- options.c_cflag |= CSTOPB;
- break;
- default:
- fprintf(stderr, "Unsupported stop bits\n");
- return -1;
- }
- options.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON);
- options.c_oflag &= ~OPOST;
- options.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
- /* Set input parity option */
- if (parity != 'n')
- options.c_iflag |= INPCK;
- options.c_cc[VTIME] = 150; // 15 seconds
- options.c_cc[VMIN] = 0;
- tcflush(fd, TCIFLUSH); /* Update the options and do it NOW */
- if (tcsetattr(fd, TCSANOW, &options) != 0)
- {
- perror("SetupSerial 3");
- return -1;
- }
- return 0;
- }
- int chan_open_serial(char *dev, int baud, int bits, char parity, int stop)
- {
- struct termios tty;
- int serial_port = open(dev, O_RDWR);
- if (serial_port < 0)
- {
- log_dbg("open dev : %s fail, error:%i %s", dev, errno, strerror(errno));
- return -1;
- }
- // Read in existing settings, and handle any error
- if (tcgetattr(serial_port, &tty) != 0)
- {
- log_dbg("Error %i from tcgetattr: %s\n", errno, strerror(errno));
- close(dev);
- return -2;
- }
- switch (parity)
- {
- case 'O':
- case 'o':
- tty.c_cflag |= PARENB;
- tty.c_iflag |= INPCK;
- tty.c_cflag |= PARODD;
- break;
- case 'E':
- case 'e':
- tty.c_cflag |= PARENB;
- tty.c_iflag |= INPCK;
- tty.c_cflag &= ~PARODD;
- break;
- case 'N':
- case 'n':
- tty.c_cflag &= ~PARENB; // Clear parity bit, disabling parity (most common)
- break;
- default:
- log_dbg("unsupported parity :%c\n", parity);
- close(dev);
- return -3;
- }
- if (stop != 1)
- {
- log_dbg("unsupported stop bit :%d\n", stop);
- close(dev);
- return -4;
- }
- else
- {
- tty.c_cflag &= ~CSTOPB; // Clear stop field, only one stop bit used in communication (most common)
- }
- switch (bits)
- {
- case 7:
- tty.c_cflag &= ~CSIZE; // Clear all bits that set the data size
- tty.c_cflag |= CS7; // 8 bits per byte (most common)
- break;
- case 8:
- tty.c_cflag &= ~CSIZE; // Clear all bits that set the data size
- tty.c_cflag |= CS8; // 8 bits per byte (most common)
- break;
- default:
- log_dbg("unsupported bit number:%d\n", bits);
- close(dev);
- return -5;
- }
- tty.c_cflag &= ~CRTSCTS; // Disable RTS/CTS hardware flow control (most common)
- tty.c_cflag |= CREAD | CLOCAL; // Turn on READ & ignore ctrl lines (CLOCAL = 1)
- tty.c_lflag &= ~ICANON;
- tty.c_lflag &= ~ECHO; // Disable echo
- tty.c_lflag &= ~ECHOE; // Disable erasure
- tty.c_lflag &= ~ECHONL; // Disable new-line echo
- tty.c_lflag &= ~ISIG; // Disable interpretation of INTR, QUIT and SUSP
- tty.c_iflag &= ~(IXON | IXOFF | IXANY); // Turn off s/w flow ctrl
- tty.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL); // Disable any special handling of received bytes
- tty.c_oflag &= ~OPOST; // Prevent special interpretation of output bytes (e.g. newline chars)
- tty.c_oflag &= ~ONLCR; // Prevent conversion of newline to carriage return/line feed
- // tty.c_oflag &= ~OXTABS; // Prevent conversion of tabs to spaces (NOT PRESENT ON LINUX)
- // tty.c_oflag &= ~ONOEOT; // Prevent removal of C-d chars (0x004) in output (NOT PRESENT ON LINUX)
- tty.c_cc[VTIME] = 10; // Wait for up to 1s (10 deciseconds), returning as soon as any data is received.
- tty.c_cc[VMIN] = 0;
- // Set in/out baud rate to be 9600
- switch (baud)
- {
- case 1200:
- cfsetispeed(&tty, B1200);
- cfsetospeed(&tty, B1200);
- break;
- case 2400:
- cfsetispeed(&tty, B2400);
- cfsetospeed(&tty, B2400);
- break;
- case 4800:
- cfsetispeed(&tty, B4800);
- cfsetospeed(&tty, B4800);
- break;
- case 9600:
- cfsetispeed(&tty, B9600);
- cfsetospeed(&tty, B9600);
- break;
- case 19200:
- cfsetispeed(&tty, B19200);
- cfsetospeed(&tty, B19200);
- break;
- case 115200:
- cfsetispeed(&tty, B115200);
- cfsetospeed(&tty, B115200);
- break;
- default:
- log_dbg("unsupported baud:%d\n", baud);
- close(dev);
- return -6;
- }
- // Save tty settings, also checking for error
- if (tcsetattr(serial_port, TCSANOW, &tty) != 0)
- {
- log_dbg("Error %i from tcsetattr: %s\n", errno, strerror(errno));
- close(dev);
- return -7;
- }
- return serial_port;
- }
- #define PF_CAN 29
- #define AF_CAN PF_CAN
- #define SIOCSCANBAUDRATE (SIOCDEVPRIVATE + 0)
- #define SIOCGCANBAUDRATE (SIOCDEVPRIVATE + 1)
- #define SOL_CAN_RAW (SOL_CAN_BASE + CAN_RAW)
- #define CAN_RAW_FILTER 1
- #define CAN_RAW_RECV_OWN_MSGS 0x4
- typedef __u32 can_baudrate_t;
- struct ifreq ifr[CHAN_NBR_MAX + 1];
- static struct chanthrd_param_t s_chanthrd_param[CHAN_NBR_MAX + 1];
- static int chan_dbcb_0(void *para, int ncolumn, char **columnvalue, char *columnname[])
- {
- int i;
- struct dbcbparam_t *pcbparam = (struct dbcbparam_t *)para;
- struct chan_t *ch;
- pcbparam->nrow++;
- log_dbg("%s, ++,row:%d;col:%d", __func__, pcbparam->nrow, ncolumn);
- ch = &chan[pcbparam->nrow];
- for (i = 0; i < ncolumn; i++)
- {
- if (strcmp("info", columnname[i]) == 0)
- {
- strcpy(ch->szinfo, columnvalue[i]);
- }
- else if (strcmp("dev", columnname[i]) == 0)
- {
- strcpy(ch->szdev, columnvalue[i]);
- }
- else if (strcmp("mode", columnname[i]) == 0)
- {
- strcpy(ch->szmode, columnvalue[i]);
- ch->mode = chan_mode_str2nbr(ch->szmode);
- }
- else if (strcmp("port", columnname[i]) == 0)
- {
- ch->port = atoi(columnvalue[i]);
- }
- else if (strcmp("baud", columnname[i]) == 0)
- {
- ch->baud = atoi(columnvalue[i]);
- }
- else if (strcmp("parity", columnname[i]) == 0)
- {
- strcpy(ch->szparity, columnvalue[i]);
- }
- else if (strcmp("servip", columnname[i]) == 0)
- {
- strcpy(ch->servip, columnvalue[i]);
- }
- else if (strcmp("servport", columnname[i]) == 0)
- {
- ch->servport = atoi(columnvalue[i]);
- }
- else if (strcmp("restart_times", columnname[i]) == 0)
- {
- ch->restart_times = atoi(columnvalue[i]);
- }
- else if (strcmp("retry_times", columnname[i]) == 0)
- {
- ch->retry_times = atoi(columnvalue[i]);
- }
- }
- pcbparam->ret = 0;
- log_dbg("%s, --,ret:%d", __func__, pcbparam->ret);
- return 0;
- }
- static void *chan_socketcan_rxthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- int i = 0;
- int rc = 0;
- struct can_frame frame;
- int chanidx = pparam->idx;
- struct chan_t *ch = &chan[chanidx];
- int sock = ch->sockfd;
- int is_ext_frm = 0;
- unsigned int id = 0;
- chan_socketcan_ringbuffer_element_t e;
- char tmpbuf[256];
- log_dbg("%s, ++, idx:%d", __func__, chanidx);
- while (1)
- {
- // usleep(2000);
- memset(&frame, 0, sizeof(struct can_frame));
- rc = read(sock, &frame, sizeof(struct can_frame));
- if (rc > 0)
- {
- if (chanidx == 22 && ch->dbg)
- {
- // log_dbg("%s, read rc:%d, idx:%d, id:%d", __func__, rc, chanidx, frame.can_id);
- }
- }
- if (frame.can_dlc)
- {
- // log_dbg("%s, read rc:%d, can_dlc:%d", __func__, rc, frame.can_dlc);
- if (ch->dbg)
- {
- is_ext_frm = (frame.can_id & CAN_EFF_FLAG) ? 1 : 0;
- if (is_ext_frm)
- {
- id = frame.can_id & CAN_EFF_MASK;
- }
- else
- {
- id = frame.can_id & CAN_SFF_MASK;
- }
- tmpbuf[0] = 0;
- dump(tmpbuf, frame.data, frame.can_dlc);
- log_dbg("%s, ID:0x%08X, data:%s", __func__, id, tmpbuf);
- }
- chan_lock(chanidx);
- e.frame = frame;
- chan_socketcan_rxrb_queue(chanidx, e);
- chan_unlock(chanidx);
- }
- else
- {
- usleep(2000);
- }
- }
- return NULL;
- }
- static void *chan_tcpservcan_rxthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- int i = 0;
- int rc = 0;
- struct can_frame frame;
- int chanidx = pparam->idx;
- struct chan_t *ch = &chan[chanidx];
- int sock = ch->sockfd;
- int is_ext_frm = 0;
- unsigned int id = 0;
- chan_tcpservcan_ringbuffer_element_t e;
- char tmpbuf[256];
- log_dbg("%s, ++, idx:%d", __func__, chanidx);
- while (1)
- {
- memset(&frame, 0, sizeof(struct can_frame));
- rc = read(sock, &frame, sizeof(struct can_frame));
- if (frame.can_dlc)
- {
- if (ch->dbg)
- {
- is_ext_frm = (frame.can_id & CAN_EFF_FLAG) ? 1 : 0;
- if (is_ext_frm)
- {
- id = frame.can_id & CAN_EFF_MASK;
- }
- else
- {
- id = frame.can_id & CAN_SFF_MASK;
- }
- tmpbuf[0] = 0;
- dump(tmpbuf, frame.data, frame.can_dlc);
- log_dbg("%s, ID:0x%08X, data:%s", __func__, id, tmpbuf);
- }
- chan_lock(chanidx);
- e.frame = frame;
- chan_tcpservcan_rxrb_queue(chanidx, e);
- chan_unlock(chanidx);
- }
- }
- return NULL;
- }
- static void *chan_tcpservcan_txthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- struct can_frame frame;
- int chanidx = pparam->idx;
- struct chan_t *ch = &chan[chanidx];
- int sock = ch->sockfd;
- chan_tcpservcan_ringbuffer_element_t e_arr[32];
- int n2write;
- int ntry2write;
- int i;
- log_dbg("%s, ++, idx:%d", __func__, chanidx);
- while (1)
- {
- // cnt = 0;
- chan_lock(chanidx);
- n2write = chan_tcpservcan_txrb_num_items(chanidx);
- if (n2write > 0)
- {
- ntry2write = n2write > (sizeof(e_arr) / sizeof(chan_tcpservcan_ringbuffer_element_t)) ? (sizeof(e_arr) / sizeof(chan_tcpservcan_ringbuffer_element_t)) : n2write;
- chan_tcpservcan_txrb_dequeue_arr(chanidx, e_arr, ntry2write);
- }
- else
- {
- ntry2write = 0;
- }
- chan_unlock(chanidx);
- if (ntry2write > 0)
- {
- for (i = 0; i < ntry2write; i++)
- {
- write(sock, &e_arr[i].frame, sizeof(struct can_frame));
- log_dbg("%s, idx:%d, tx %d bytes", __func__, chanidx, sizeof(struct can_frame));
- }
- }
- usleep(3000); /* 3ms */
- }
- return NULL;
- }
- static void *chan_socketcan_txthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- struct can_frame frame;
- int chanidx = pparam->idx;
- struct chan_t *ch = &chan[chanidx];
- int sock = ch->sockfd;
- chan_socketcan_ringbuffer_element_t e;
- int cnt = 0;
- log_dbg("%s, ++, idx:%d", __func__, chanidx);
- int nbytes = 0;
- while (1)
- {
- cnt = 3;
- chan_lock(chanidx);
- if (chan_socketcan_txrb_dequeue(chanidx, &e) != 0)
- {
- while (cnt--)
- {
- nbytes = write(sock, &e.frame, sizeof(chan_socketcan_ringbuffer_element_t));
- if (nbytes != sizeof(chan_socketcan_ringbuffer_element_t))
- {
- log_info("%s,write err(%d)", __func__, nbytes);
- }
- else
- {
- if (chanidx == 22 && ch->dbg)
- {
- log_dbg("%s, idx:%d, tx %d bytes, id : %u", __func__, chanidx, nbytes, e.frame.can_id);
- }
- break;
- }
- }
- }
- chan_unlock(chanidx);
- usleep(1000);
- }
- return NULL;
- }
- static void *chan_serial_rxthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- int chan_idx = pparam->idx;
- struct chan_t *ch = &chan[chan_idx];
- int fd = ch->fd;
- chan_serial_ringbuffer_element_t e;
- int nread;
- char buff[128];
- char dump_buf[1024];
- int i;
- log_dbg("%s, ++, idx:%d, serial", __func__, chan_idx);
- while (true)
- {
- if ((nread = read(fd, buff, 100)) > 0)
- {
- if (ch->dbg > 0)
- {
- chan_dump(dump_buf, buff, nread);
- log_dbg("%s, idx:%d, rx %d bytes:%s", __func__, chan_idx, nread, dump_buf);
- }
- chan_lock(chan_idx);
- for (i = 0; i < nread; i++)
- {
- e.c = buff[i];
- chan_serial_rxrb_queue(chan_idx, e);
- }
- chan_unlock(chan_idx);
- }
- usleep(2000); /* 2ms */
- }
- return NULL;
- }
- static void *chan_serial_txthrd(void *thrdparam)
- {
- struct chanthrd_param_t *pparam = (struct chanthrd_param_t *)thrdparam;
- int chan_idx = pparam->idx;
- struct chan_t *ch = &chan[chan_idx];
- int fd = ch->fd;
- chan_serial_ringbuffer_element_t e_arr[128];
- int towrite;
- int needtowrite;
- char buff[128];
- char dump_buf[1024];
- int i;
- log_dbg("%s, ++, idx:%d, serial", __func__, chan_idx);
- while (true)
- {
- chan_lock(chan_idx);
- needtowrite = chan_serial_txrb_num_items(chan_idx);
- if (needtowrite > 0)
- {
- towrite = needtowrite > sizeof(buff) ? sizeof(buff) : needtowrite;
- chan_serial_txrb_dequeue_arr(chan_idx, e_arr, towrite);
- }
- else
- {
- towrite = 0;
- }
- chan_unlock(chan_idx);
- if (towrite > 0)
- {
- for (i = 0; i < towrite; i++)
- {
- buff[i] = e_arr[i].c;
- }
- write(fd, buff, towrite);
- if (ch->dbg > 0)
- {
- chan_dump(dump_buf, buff, towrite);
- log_dbg("%s, idx:%d, tx %d bytes:%s", __func__, chan_idx, towrite, dump_buf);
- }
- }
- usleep(2000);
- }
- return NULL;
- }
- // void chan_set_mbs( int idx, int devm, int devidx )
- //{
- // chan[idx].mbsdevm = devm;
- // chan[idx].mbsdevidx = devidx;
- // }
- int chan_set_nbr(int nbr)
- {
- channbr = nbr;
- return 0;
- }
- int chan_get_nbr()
- {
- return channbr;
- }
- int chan_init(void)
- {
- int result = 0;
- int ret = 0;
- int i = 0;
- // int* channbr = &STA.channbr;
- struct chan_t *ch;
- char *errmsg = NULL;
- char sql[1024];
- struct dbcbparam_t cbparam;
- sqlite3 *db = NULL;
- log_dbg("%s, ++", __func__);
- plt_lock_ctndb();
- db = plt_get_ctndb();
- sprintf(sql, "select * from chan");
- cbparam.nrow = 0;
- result = sqlite3_exec(db, sql, chan_dbcb_0, (void *)&cbparam, &errmsg);
- plt_unlock_ctndb();
- if (result != SQLITE_OK)
- {
- ret = -1;
- }
- else if (cbparam.ret != 0)
- {
- ret = -2;
- }
- else
- {
- chan_set_nbr(cbparam.nrow);
- for (i = 1; i <= chan_get_nbr(); i++)
- {
- ch = &chan[i];
- ch->errcnt = 0;
- ch->dbg = 0;
- ch->ctx = NULL;
- ch->started = 0;
- pthread_mutex_init(&ch->mutex, NULL);
- if (chan_start(i) < 0)
- {
- log_dbg("%s, chan idx:%d, start fail ", __func__, i);
- }
- // pthread_mutex_init(&ch->mutexdat, NULL);
- // if( chan_start(i) < 0 ){
- // }else{
- // log_dbg("%s, idx:%d, start ok",__func__,i);
- // }
- }
- }
- log_dbg("%s--, ret:%d", __func__, ret);
- return ret;
- }
- // func code:0x06
- int chan_write_single_register(int idx, int slaveaddr, int regaddr, int regval)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_write_register(ch->ctx, regaddr, regval);
- modbus_flush(ch->ctx);
- if (rc != 1)
- {
- ch->errcnt++;
- ret = -3;
- }
- }
- // log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, rc:%d, regval:%d",
- // __func__,idx,slaveaddr,regaddr,rc,regval);
- return ret;
- }
- // func code:0x06
- int chan_write_single_register_with_retry(int idx, int slaveaddr, int regaddr, int regval)
- {
- int rc;
- int ret = -1;
- struct chan_t *ch = &chan[idx];
- int retry_times = ch->retry_times;
- int restart_times = ch->restart_times;
- if (ch->ctx == NULL)
- {
- ret = -2;
- }
- else
- {
- while (restart_times-- > 0)
- {
- while (retry_times-- > 0)
- {
- if (ch->ctx != NULL)
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_write_register(ch->ctx, regaddr, regval);
- modbus_flush(ch->ctx);
- if (rc != 1)
- {
- ch->errcnt++;
- usleep(100000); /* 100ms */
- }
- else
- {
- ret = 0; /* ok */
- goto leave;
- }
- }
- }
- usleep(100000); /* 100ms */
- chan_start(idx);
- retry_times = ch->retry_times;
- }
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, rc:%d, regval:%d",
- __func__, idx, slaveaddr, regaddr, rc, regval);
- }
- return ret;
- }
- // func code:0x10
- int chan_write_multi_registers(int idx, int slaveaddr, int regaddr, int nb, unsigned short *regval)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_write_registers(ch->ctx, regaddr, nb, regval);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ch->dbg == 1)
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, rc:%d",
- __func__,
- idx,
- slaveaddr,
- regaddr,
- nb,
- rc);
- return ret;
- }
- // FUNC CODE: 0x02
- int chan_read_input_bits(int idx, int slaveaddr, int regaddr, int nb, unsigned char *dest)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_input_bits(ch->ctx, regaddr, nb, dest);
- if (rc != nb)
- {
- _error_print(ch->ctx, __func__);
- ch->errcnt++;
- ret = -2;
- }
- modbus_flush(ch->ctx);
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, rc:%d",
- __func__,
- idx,
- slaveaddr,
- regaddr,
- nb,
- rc);
- }
- return rc;
- }
- int chan_read_input_bits_with_retry(int idx, int slaveaddr, int regaddr, int nb, unsigned char *dest)
- {
- int rc;
- int ret = -1;
- struct chan_t *ch = &chan[idx];
- int retry_times = ch->retry_times;
- int restart_times = ch->restart_times;
- while (restart_times-- > 0)
- {
- while (retry_times-- > 0)
- {
- if (ch->ctx != NULL)
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = chan_read_input_bits(idx, slaveaddr, regaddr, nb, dest);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- usleep(100000); /* 100ms */
- }
- else
- {
- ret = 0; /* ok */
- goto leave;
- }
- }
- }
- usleep(100000); /* 100ms */
- chan_start(idx);
- retry_times = ch->retry_times;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, fail",
- __func__, idx, slaveaddr, regaddr, nb);
- }
- return ret;
- }
- // FUNC CODE: 0x04
- int chan_read_input_registers(int idx, int slaveaddr, int regaddr, int nb, unsigned short *dest)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_input_registers(ch->ctx, regaddr, nb, dest);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, rc:%d",
- __func__,
- idx,
- slaveaddr,
- regaddr,
- nb,
- rc);
- }
- return ret;
- }
- int chan_read_input_registers_with_retry(int idx, int slaveaddr, int regaddr, int nb, unsigned short *regval)
- {
- int rc;
- int ret = -1;
- struct chan_t *ch = &chan[idx];
- int retry_times = ch->retry_times;
- int restart_times = ch->restart_times;
- while (restart_times-- > 0)
- {
- while (retry_times-- > 0)
- {
- if (ch->ctx != NULL)
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_input_registers(ch->ctx, regaddr, nb, regval);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- usleep(100000); /* 100ms */
- }
- else
- {
- ret = 0; /* ok */
- goto leave;
- }
- }
- }
- usleep(100000); /* 100ms */
- chan_start(idx);
- retry_times = ch->retry_times;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, fail",
- __func__, idx, slaveaddr, regaddr, nb);
- }
- return ret;
- }
- // func code:0x01
- // nb : bits count
- int chan_read_bits(int idx, int slaveaddr, int regaddr, int nb, unsigned char *dest)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_bits(ch->ctx, regaddr, nb, dest);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, rc:%d",
- __func__,
- idx,
- slaveaddr,
- regaddr,
- nb,
- rc);
- }
- return ret;
- }
- // func code:0x05
- // nb : bits count
- int chan_write_bit(int idx, int slaveaddr, int addr, int status)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_write_bit(ch->ctx, addr, status);
- modbus_flush(ch->ctx);
- if (rc <= 0)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, status:%d, ret:%d",
- __func__,
- idx,
- slaveaddr,
- addr,
- status,
- ret);
- }
- return ret;
- }
- int chan_write_bits(int idx, int slaveaddr, int addr, int nb, unsigned char *status)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_write_bits(ch->ctx, addr, nb, status);
- modbus_flush(ch->ctx);
- if (rc <= 0)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, status:%hhn, ret:%d",
- __func__,
- idx,
- slaveaddr,
- addr,
- status,
- ret);
- }
- return ret;
- }
- int chan_read_gpio(int idx, int *val)
- {
- chan_lock(idx);
- // log_dbg("read gpio, chan idx %d\n", idx);
- char buf[4096] = {0};
- sprintf(buf, "/sys/class/gpio/gpio%s/value", chan[idx].szdev);
- int fd_value = -1;
- if (chan[idx].mode != CHANMODE_DO && chan[idx].mode != CHANMODE_DI)
- {
- log_dbg("channel %d is not DIDO mode\n", idx);
- chan_unlock(idx);
- return -1;
- }
- fd_value = open(buf, O_RDONLY);
- if (fd_value == -1)
- {
- log_dbg("read value %s\n", strerror(errno));
- chan_unlock(idx);
- return -1;
- }
- memset(buf, 0, sizeof(buf));
- lseek(fd_value, 0, SEEK_SET);
- int rdsize = read(fd_value, buf, sizeof(buf));
- // log_dbg("read value size : %d\n", rdsize);
- if (rdsize < 0)
- {
- log_dbg("read value %s\n", strerror(errno));
- close(fd_value);
- chan_unlock(idx);
- return -1;
- }
- // log_dbg("gpio%s value: %s\n", chan[idx].szdev, buf);
- close(fd_value);
- *val = atoi(buf);
- chan_unlock(idx);
- return 0;
- }
- int chan_write_gpio(int idx, int val)
- {
- chan_lock(idx);
- // log_dbg("write gpio, chan idx %d\n", idx);
- char buf[4096] = {0};
- sprintf(buf, "/sys/class/gpio/gpio%s/value", chan[idx].szdev);
- int fd_value = -1;
- if (chan[idx].mode != CHANMODE_DO)
- {
- log_dbg("channel %d is not DO mode\n", idx);
- chan_unlock(idx);
- return -1;
- }
- else
- {
- fd_value = open(buf, O_RDWR);
- if (fd_value == -1)
- {
- log_dbg("value %s\n", strerror(errno));
- chan_unlock(idx);
- return -1;
- }
- sprintf(buf, "%d", val);
- if (write(fd_value, buf, sizeof(buf)) == -1)
- {
- log_dbg("write value %s\n", strerror(errno));
- close(fd_value);
- chan_unlock(idx);
- return -1;
- }
- // log_dbg("write value %s success\n", buf);
- }
- close(fd_value);
- chan_unlock(idx);
- return 0;
- }
- int chan_read_holdingregisters(int idx, int slaveaddr, int regaddr, int nb, unsigned short *regval)
- {
- int rc;
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_registers(ch->ctx, regaddr, nb, regval);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- ret = -2;
- }
- }
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, rc:%d",
- __func__, idx, slaveaddr, regaddr, nb, rc);
- }
- return ret;
- }
- int chan_read_holdingregisters_with_retry(int idx, int slaveaddr, int regaddr, int nb, unsigned short *regval)
- {
- int rc;
- int ret = -1;
- struct chan_t *ch = &chan[idx];
- int retry_times = ch->retry_times;
- int restart_times = ch->restart_times;
- while (restart_times-- > 0)
- {
- while (retry_times-- > 0)
- {
- if (ch->ctx != NULL)
- {
- modbus_set_slave(ch->ctx, slaveaddr);
- rc = modbus_read_registers(ch->ctx, regaddr, nb, regval);
- modbus_flush(ch->ctx);
- if (rc != nb)
- {
- ch->errcnt++;
- usleep(100000); /* 100ms */
- }
- else
- {
- ret = 0; /* ok */
- goto leave;
- }
- }
- }
- usleep(100000); /* 100ms */
- chan_start(idx);
- retry_times = ch->retry_times;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, idx:%d, slaveaddr:%d, regaddr:%d, nb:%d, fail",
- __func__, idx, slaveaddr, regaddr, nb);
- }
- return ret;
- }
- int chan_enable_dbg(int idx)
- {
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx != NULL)
- {
- ch->dbg = 1;
- modbus_set_debug(ch->ctx, 1);
- }
- else
- {
- ch->dbg = 1;
- }
- return ret;
- }
- int chan_disable_dbg(int idx)
- {
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- if (ch->ctx != NULL)
- {
- ch->dbg = 0;
- modbus_set_debug(ch->ctx, 0);
- }
- else
- {
- ch->dbg = 0;
- }
- return ret;
- }
- int chan_set_dbg(int idx, int enable)
- {
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- ch->dbg = enable;
- if (ch->ctx != NULL)
- {
- modbus_set_debug(ch->ctx, enable);
- }
- return ret;
- }
- int chan_set_en(int idx, int enable)
- {
- int ret = 0;
- struct chan_t *ch = &chan[idx];
- ch->en = enable;
- log_dbg("%s, idx:%d, enable:%d", __func__, idx, enable);
- return ret;
- }
- int chan_get_en(int idx)
- {
- struct chan_t *ch = &chan[idx];
- return ch->en;
- }
- void chan_serial_rxrb_init(int idx)
- {
- chan_serial_ringbuffer_init(chan[idx].serial_rxrb);
- }
- void chan_serial_txrb_init(int idx)
- {
- chan_serial_ringbuffer_init(chan[idx].serial_txrb);
- }
- void chan_serial_rxrb_queue(int idx, chan_serial_ringbuffer_element_t e)
- {
- chan_serial_ringbuffer_queue(chan[idx].serial_rxrb, e);
- }
- int chan_serial_rxrb_dequeue_arr(int idx, chan_serial_ringbuffer_element_t *e, int len)
- {
- return chan_serial_ringbuffer_dequeue_arr(chan[idx].serial_rxrb, e, len);
- }
- int chan_serial_rxrb_num_items(int idx)
- {
- return chan_serial_ringbuffer_num_items(chan[idx].serial_rxrb);
- }
- int chan_serial_txrb_num_items(int idx)
- {
- return chan_serial_ringbuffer_num_items(chan[idx].serial_txrb);
- }
- int chan_serial_txrb_dequeue_arr(int idx, chan_serial_ringbuffer_element_t *e, int len)
- {
- return chan_serial_ringbuffer_dequeue_arr(chan[idx].serial_txrb, e, len);
- }
- void chan_serial_txrb_queue_arr(int idx, chan_serial_ringbuffer_element_t *e, int len)
- {
- chan_serial_ringbuffer_queue_arr(chan[idx].serial_txrb, e, len);
- }
- void chan_socketcan_rxrb_init(int idx)
- {
- chan_socketcan_ringbuffer_init(chan[idx].socketcan_rxrb);
- }
- void chan_socketcan_txrb_init(int idx)
- {
- chan_socketcan_ringbuffer_init(chan[idx].socketcan_txrb);
- }
- void chan_socketcan_rxrb_queue(int idx, chan_socketcan_ringbuffer_element_t e)
- {
- chan_socketcan_ringbuffer_queue(chan[idx].socketcan_rxrb, e);
- }
- void chan_socketcan_rxrb_queue_arr(int idx, chan_socketcan_ringbuffer_element_t *e, int len)
- {
- chan_socketcan_ringbuffer_queue_arr(chan[idx].socketcan_rxrb, e, len);
- }
- int chan_socketcan_rxrb_dequeue(int idx, chan_socketcan_ringbuffer_element_t *e)
- {
- return chan_socketcan_ringbuffer_dequeue(chan[idx].socketcan_rxrb, e);
- }
- int chan_socketcan_rxrb_dequeue_arr(int idx, chan_socketcan_ringbuffer_element_t *e, int len)
- {
- return chan_socketcan_ringbuffer_dequeue_arr(chan[idx].socketcan_rxrb, e, len);
- }
- int chan_socketcan_txrb_num_items(int idx)
- {
- return chan_socketcan_ringbuffer_num_items(chan[idx].socketcan_txrb);
- }
- int chan_socketcan_rxrb_num_items(int idx)
- {
- return chan_socketcan_ringbuffer_num_items(chan[idx].socketcan_rxrb);
- }
- int chan_socketcan_txrb_dequeue_arr(int idx, chan_socketcan_ringbuffer_element_t *e, int len)
- {
- return chan_socketcan_ringbuffer_dequeue_arr(chan[idx].socketcan_txrb, e, len);
- }
- int chan_socketcan_txrb_dequeue(int idx, chan_socketcan_ringbuffer_element_t *e)
- {
- return chan_socketcan_ringbuffer_dequeue(chan[idx].socketcan_txrb, e);
- }
- void chan_socketcan_txrb_queue(int idx, chan_socketcan_ringbuffer_element_t e)
- {
- return chan_socketcan_ringbuffer_queue(chan[idx].socketcan_txrb, e);
- }
- void chan_tcpservcan_rxrb_init(int idx)
- {
- chan_tcpservcan_ringbuffer_init(chan[idx].tcpservcan_rxrb);
- }
- void chan_tcpservcan_txrb_init(int idx)
- {
- chan_tcpservcan_ringbuffer_init(chan[idx].tcpservcan_txrb);
- }
- void chan_tcpservcan_rxrb_queue(int idx, chan_tcpservcan_ringbuffer_element_t e)
- {
- chan_tcpservcan_ringbuffer_queue(chan[idx].tcpservcan_rxrb, e);
- }
- int chan_tcpservcan_txrb_num_items(int idx)
- {
- return chan_tcpservcan_ringbuffer_num_items(chan[idx].tcpservcan_txrb);
- }
- int chan_tcpservcan_txrb_dequeue_arr(int idx, chan_tcpservcan_ringbuffer_element_t *e, int len)
- {
- return chan_tcpservcan_ringbuffer_dequeue_arr(chan[idx].tcpservcan_txrb, e, len);
- }
- int chan_start(int idx)
- {
- pthread_t xthrd;
- struct hostent *he;
- struct sockaddr_in my_addr;
- struct timeval t;
- int sock;
- struct sockaddr_can addr;
- int ret = 0;
- int rc = 0;
- struct chan_t *ch = NULL;
- char buf[128];
- struct timeval timeout = {1, 0};
- int recv_own_msgs = 0; // set loop back: 1 enable 0 disable
- const UCHAR ucSlaveID[] = {0xAA, 0xBB, 0xCC};
- struct sockaddr_in servaddr;
- int slaveadr = 0;
- log_dbg("%s, ++, idx:%d", __func__, idx);
- ch = &chan[idx];
- ch->started = 0;
- if (ch->mode == CHANMODE_SERIAL)
- {
- log_dbg("%s, idx:%d, mode:%s, dev:%s, parity:%s, baud:%d", __func__, idx, ch->szmode, ch->szdev, ch->szparity, ch->baud);
- sprintf(buf, "/dev/%s", ch->szdev);
- // ch->fd = open(buf, O_RDWR);
- ch->fd = chan_open_serial(buf, ch->baud, 8, ch->szparity[0], 1);
- if (ch->fd < 0)
- {
- log_dbg("%s, idx:%d, open %s fail", __func__, idx, buf);
- ch->fd = 0;
- ret = -1;
- }
- else
- {
- // if(chan_set_baud(ch->fd,ch->baud) < 0){
- // log_dbg("%s, idx:%d, set baud %s %d fail", __func__, idx, buf,ch->baud);
- // close(ch->fd);
- // ch->fd = 0;
- // }else if( chan_set_parity(ch->fd, 8, 1, ch->szparity[0]) < 0 ){
- // log_dbg("%s, idx:%d, set parity %s %s fail", __func__, idx, buf, ch->szparity);
- // close(ch->fd);
- // ch->fd = 0;
- // ret = -1;
- // }else{
- ch->serial_rxrb = (chan_serial_ringbuffer_t *)malloc(sizeof(chan_serial_ringbuffer_t));
- if (ch->serial_rxrb != NULL)
- {
- chan_serial_rxrb_init(idx);
- ch->serial_txrb = (chan_serial_ringbuffer_t *)malloc(sizeof(chan_serial_ringbuffer_t));
- if (ch->serial_txrb != NULL)
- {
- chan_serial_txrb_init(idx);
- }
- else
- {
- log_dbg("%s, idx:%d, malloc tx ringbuffer fail", __func__, idx);
- free(ch->serial_rxrb);
- ret = -1;
- }
- }
- else
- {
- log_dbg("%s, idx:%d, malloc rx ringbuffer fail", __func__, idx);
- ret = -1;
- }
- chanthrd_param[idx].idx = idx;
- if (pthread_create(&xthrd, NULL, chan_serial_rxthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_serial_rxthrd create fail", __func__);
- ret = -1;
- }
- else if (pthread_create(&xthrd, NULL, chan_serial_txthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_serial_rxthrd create fail", __func__);
- ret = -1;
- }
- //}
- }
- }
- else if (ch->mode == CHANMODE_SOCKET_CAN)
- {
- log_dbg("%s, idx:%d, mode:%s, dev:%s", __func__, idx, ch->szmode, ch->szdev);
- sock = socket(PF_CAN, SOCK_RAW, CAN_RAW);
- if (sock < 0)
- {
- printf("error\n");
- ret = -1;
- }
- else
- {
- addr.can_family = AF_CAN;
- strcpy(ifr[idx].ifr_name, ch->szdev);
- rc = ioctl(sock, SIOCGIFINDEX, &ifr[idx]); // get index
- if (rc && ifr[idx].ifr_ifindex == 0)
- {
- log_dbg("%s, idx:%d, rc && ifr[idx].ifr_ifindex == 0", __func__, idx);
- close(sock);
- ret = -1;
- }
- else
- {
- addr.can_ifindex = ifr[idx].ifr_ifindex;
- setsockopt(sock, SOL_CAN_RAW, CAN_RAW_RECV_OWN_MSGS, &recv_own_msgs, sizeof(recv_own_msgs));
- if (bind(sock, (struct sockaddr *)&addr, sizeof(addr)) < 0)
- {
- log_dbg("%s, idx:%d, bind error", __func__, idx);
- close(sock);
- ret = -1;
- }
- else
- {
- ch->sockfd = sock;
- ch->socketcan_rxrb = (chan_socketcan_ringbuffer_t *)malloc(sizeof(chan_socketcan_ringbuffer_t));
- if (ch->socketcan_rxrb != NULL)
- {
- chan_socketcan_rxrb_init(idx);
- ch->socketcan_txrb = (chan_socketcan_ringbuffer_t *)malloc(sizeof(chan_socketcan_ringbuffer_t));
- if (ch->socketcan_txrb != NULL)
- {
- chan_socketcan_txrb_init(idx);
- }
- else
- {
- log_dbg("%s, idx:%d, malloc tx ringbuffer fail", __func__, idx);
- free(ch->socketcan_rxrb);
- ret = -1;
- }
- }
- else
- {
- log_dbg("%s, idx:%d, malloc rx ringbuffer fail", __func__, idx);
- ret = -1;
- }
- chanthrd_param[idx].idx = idx;
- if (pthread_create(&xthrd, NULL, chan_socketcan_rxthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_socketcan_rxthrd create fail", __func__);
- ret = -1;
- }
- else if (pthread_create(&xthrd, NULL, chan_socketcan_txthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_socketcan_rxthrd create fail", __func__);
- ret = -1;
- }
- }
- }
- }
- }
- else if (ch->mode == CHANMODE_TCPSERV_CAN)
- {
- log_dbg("%s, idx:%d, mode:%s, host:%s, port:%d", __func__, idx, ch->szmode, ch->servip, ch->servport);
- sock = socket(AF_INET, SOCK_STREAM, 0);
- if (sock < 0)
- {
- log_dbg("%s, tcpserv_can socket fail", __func__);
- ret = -1;
- }
- else
- {
- bzero(&servaddr, sizeof(servaddr));
- servaddr.sin_family = AF_INET;
- servaddr.sin_port = htons(ch->servport);
- inet_pton(AF_INET, ch->servip, &servaddr.sin_addr);
- rc = connect(sock, (SA *)&servaddr, sizeof(servaddr));
- if (rc < 0)
- {
- log_dbg("%s, tcpserv_can connect fail", __func__);
- ret = -1;
- }
- else
- {
- ch->sockfd = sock;
- ch->tcpservcan_rxrb = (chan_tcpservcan_ringbuffer_t *)malloc(sizeof(chan_tcpservcan_ringbuffer_t));
- if (ch->tcpservcan_rxrb != NULL)
- {
- chan_tcpservcan_rxrb_init(idx);
- ch->tcpservcan_txrb = (chan_tcpservcan_ringbuffer_t *)malloc(sizeof(chan_tcpservcan_ringbuffer_t));
- if (ch->tcpservcan_txrb != NULL)
- {
- chan_tcpservcan_txrb_init(idx);
- }
- else
- {
- log_dbg("%s, idx:%d, malloc tx ringbuffer fail", __func__, idx);
- free(ch->tcpservcan_rxrb);
- ret = -1;
- }
- }
- else
- {
- log_dbg("%s, idx:%d, malloc rx ringbuffer fail", __func__, idx);
- ret = -1;
- }
- chanthrd_param[idx].idx = idx;
- if (pthread_create(&xthrd, NULL, chan_tcpservcan_rxthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_tcpservcan_rxthrd create fail", __func__);
- ret = -1;
- }
- else if (pthread_create(&xthrd, NULL, chan_tcpservcan_txthrd, &chanthrd_param[idx]) != 0)
- {
- log_dbg("%s, chan_tcpservcan_rxthrd create fail", __func__);
- ret = -1;
- }
- }
- }
- }
- else if (ch->mode == CHANMODE_MODBUS_RTU)
- {
- sprintf(buf, "/dev/%s", ch->szdev);
- log_dbg("%s, idx:%d, mode:%s, dev:%s", __func__, idx, ch->szmode, buf);
- if (ch->ctx != NULL)
- {
- log_dbg("%s, idx:%d, modbus rtu, ctx:0x%08X, cleared", __func__, idx, (unsigned int)(ch->ctx));
- modbus_close(ch->ctx);
- modbus_free(ch->ctx);
- ch->ctx = NULL;
- }
- ch->ctx = modbus_new_rtu(buf, ch->baud, ch->szparity[0], 8, 1);
- if (ch->ctx == NULL)
- {
- modbus_set_debug(ch->ctx, 1);
- log_dbg("%s, idx:%d, modbus rtu new fail", __func__, idx);
- ch->started = 0;
- }
- else if (modbus_connect(ch->ctx) == -1)
- {
- log_dbg("%s, idx:%d, modbus rtu connect fail", __func__, idx);
- modbus_free(ch->ctx);
- ch->ctx = NULL;
- }
- else
- {
- t.tv_sec = 0;
- t.tv_usec = 1000000; // 20s, 为了减少一些慢速设备超时导致的大量的日志
- modbus_set_response_timeout(ch->ctx, &t);
- }
- }
- else if (strcmp(ch->szmode, "modbus_rtu_udp") == 0)
- {
- // sprintf(buf,"/dev/%s",chn->szPort);
- ch->ctx = modbus_new_rtuudp(ch->servip, ch->servport);
- if (ch->ctx == NULL)
- {
- ret = -3;
- }
- else if (modbus_connect(ch->ctx) == -1)
- {
- ret = -4;
- modbus_free(ch->ctx);
- }
- else
- {
- t.tv_sec = 0;
- t.tv_usec = 1000000; // 1000ms
- modbus_set_response_timeout(ch->ctx, &t);
- }
- }
- else if (strcmp(ch->szmode, "modbus_rtu_tcp") == 0)
- {
- // sprintf(buf,"/dev/%s",chn->szPort);
- ch->ctx = modbus_new_rtutcp(ch->servip, ch->servport);
- if (ch->ctx == NULL)
- {
- ret = -5;
- }
- else if (modbus_connect(ch->ctx) == -1)
- {
- ret = -6;
- modbus_free(ch->ctx);
- }
- else
- {
- t.tv_sec = 0;
- t.tv_usec = 1000000; // 1000ms
- modbus_set_response_timeout(ch->ctx, &t);
- }
- }
- else if (ch->mode == CHANMODE_MODBUS_TCP)
- {
- if (ch->ctx != NULL)
- {
- log_dbg("%s, idx:%d, modbus tcp, ctx:0x%08X, cleared", __func__, idx, (unsigned int)(ch->ctx));
- modbus_close(ch->ctx);
- modbus_free(ch->ctx);
- ch->ctx = NULL;
- }
- ch->ctx = modbus_new_tcp(ch->servip, ch->servport);
- if (ch->ctx == NULL)
- {
- log_dbg("%s, idx:%d, modbus tcp new fail", __func__, idx);
- ch->started = 0;
- }
- else if (modbus_connect(ch->ctx) == -1)
- {
- log_dbg("%s, idx:%d, modbus tcp connect fail", __func__, idx);
- modbus_free(ch->ctx);
- ch->ctx = NULL;
- ch->started = 0;
- }
- else
- {
- log_dbg("%s, idx:%d, modbus tcp, ctx:0x%08X, start ok", __func__, idx, (unsigned int)(ch->ctx));
- ch->started = 1;
- }
- }
- else if (ch->mode == CHANMODE_DI || ch->mode == CHANMODE_DO)
- {
- char buf[4096] = {0};
- struct stat file_info;
- sprintf(buf, "/sys/class/gpio/gpio%s", ch->szdev);
- if (stat(buf, &file_info) != -1)
- {
- log_dbg("stat : gpio path exported: %s\n", buf);
- // if (file_info.st_mode & S_IFDIR)
- // {
- // log_dbg("%s, gpio%s has been exported\n", ch->szdev);
- // }
- }
- else
- {
- log_dbg("%s, exporting gpio%s \n", __func__, ch->szdev);
- int fd_export = open(EXPORT_PATH, O_WRONLY);
- if (fd_export == -1)
- {
- log_dbg("open path %s failed : %s\n", EXPORT_PATH, strerror(errno));
- return -1;
- }
- if (write(fd_export, ch->szdev, strlen(ch->szdev)) == -1)
- {
- log_dbg("write path %s\n", strerror(errno));
- close(fd_export);
- return -1;
- }
- log_dbg("export / unexport %s success\n", ch->szdev);
- close(fd_export);
- }
- // 设置gpio方向
- log_dbg("set gpio%s direction\n", ch->szdev);
- sprintf(buf, "/sys/class/gpio/gpio%s/direction", ch->szdev);
- log_dbg("direction path: %s\n", buf);
- int fd_direction = open(buf, O_RDWR);
- if (fd_direction == -1)
- {
- log_dbg("direction %s\n", strerror(errno));
- return -1;
- }
- if (ch->mode == CHANMODE_DI)
- {
- sprintf(buf, "%s", DIR_IN);
- }
- else
- {
- sprintf(buf, "%s", DIR_OUT);
- }
- if (write(fd_direction, buf, strlen(buf)) == -1)
- {
- log_dbg("write direction %s\n", strerror(errno));
- close(fd_direction);
- return -1;
- }
- log_dbg("set gpio%s direction success\n", ch->szdev);
- close(fd_direction);
- ret = 0;
- }
- else
- {
- log_dbg("%s, unknown ch mode :%s", __func__, ch->szmode);
- ret = -1;
- }
- leave:
- log_dbg("%s, --,idx:%d, ret:%d", __func__, idx, ret);
- return ret;
- }
- int chan_mode_str2nbr(char *szmode)
- {
- int mode = CHANMODE_UNKNOWN;
- if (szmode == NULL)
- {
- return CHANMODE_UNKNOWN;
- }
- if (strcmp(szmode, "serial") == 0)
- {
- mode = CHANMODE_SERIAL;
- }
- else if (strcmp(szmode, "socket_can") == 0)
- {
- mode = CHANMODE_SOCKET_CAN;
- }
- else if (strcmp(szmode, "tcp_can") == 0)
- {
- mode = CHANMODE_TCPSERV_CAN;
- }
- else if (strcmp(szmode, "modbus_rtu") == 0)
- {
- mode = CHANMODE_MODBUS_RTU;
- }
- else if (strcmp(szmode, "modbus_tcp") == 0)
- {
- mode = CHANMODE_MODBUS_TCP;
- }
- else if (strcmp(szmode, "di") == 0)
- {
- mode = CHANMODE_DI;
- }
- else if (strcmp(szmode, "do") == 0)
- {
- mode = CHANMODE_DO;
- }
- else
- {
- mode = CHANMODE_UNKNOWN;
- }
- return mode;
- }
- int chan_reset(int idx)
- {
- struct timeval t;
- int ret = 0;
- char buf[32];
- struct chan_t *ch = &chan[idx];
- log_dbg("%s, ++, idx:%d", __func__, idx);
- if (strcmp(ch->szmode, "modbus_tcp") == 0)
- {
- ch->rstcnt += 1;
- if (ch->ctx != NULL)
- {
- modbus_close(ch->ctx);
- modbus_free(ch->ctx);
- }
- ch->ctx = modbus_new_tcp(ch->servip, ch->servport);
- if (ch->ctx == NULL)
- {
- ret = -1;
- }
- else if (modbus_connect(ch->ctx) == -1)
- {
- modbus_free(ch->ctx);
- ch->ctx = NULL;
- ret = -2;
- }
- else
- {
- log_dbg("%s, idx:%d, ctx:0x%08X init success", __func__, idx, (unsigned int)(ch->ctx));
- }
- }
- else
- {
- ret = -10;
- }
- log_dbg("%s, --, idx:%d, ret:%d", __func__, idx, ret);
- return ret;
- }
- int chan_get_mode(int idx)
- {
- return chan[idx].mode;
- }
- char *chan_get_info_str(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return NULL;
- }
- else
- {
- return chan[idx].szinfo;
- }
- }
- char *chan_get_servip_str(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return NULL;
- }
- else
- {
- return chan[idx].servip;
- }
- }
- int chan_get_servport(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].servport;
- }
- }
- int chan_get_baud(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].baud;
- }
- }
- char *chan_get_parity_str(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return NULL;
- }
- else
- {
- return chan[idx].szparity;
- }
- }
- char *chan_get_dev_str(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return NULL;
- }
- else
- {
- return chan[idx].szdev;
- }
- }
- int chan_get_port(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].port;
- }
- }
- char *chan_get_mode_str(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return NULL;
- }
- else
- {
- return chan[idx].szmode;
- }
- }
- int chan_get_errcnt(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].errcnt;
- }
- }
- int chan_get_started(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].started;
- }
- }
- int chan_get_restart_times(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].restart_times;
- }
- }
- int chan_get_retry_times(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].retry_times;
- }
- }
- int chan_get_dbg(int idx)
- {
- if (idx > chan_get_nbr())
- {
- return -1;
- }
- else
- {
- return chan[idx].dbg;
- }
- }
- int chan_get_tool_data(int idx, char *buf)
- {
- struct chan_t *ch = &chan[idx];
- sprintf(buf, " [%d]info:%s mode:%s dev:%s port:%d servip:%s servport:%d baud:%d dbg:%d started:%d errcnt:0x%08X retry_times:%d restart_times:%d\n",
- idx, ch->szinfo, ch->szmode, ch->szdev, ch->port, ch->servip, ch->servport,
- ch->baud, ch->dbg, ch->started, ch->errcnt, ch->retry_times, ch->restart_times);
- }
- int chan_get_tool_all_data(char *buf)
- {
- int i = 0;
- char buf_temp[1024];
- sprintf(buf, "" REVERSE " CHAN " NONE " nbr:%d\n", channbr);
- for (i = 1; i <= chan_get_nbr(); i++)
- {
- chan_get_tool_data(i, buf_temp);
- // printf("%s",buf_temp);
- strcat(buf, buf_temp);
- }
- return 0;
- }
- int chan_get_bkds_data(char *buf)
- {
- char buf_temp[4096];
- int i = 0;
- sprintf(buf, "\"chan\":[");
- for (i = 1; i <= chan_get_nbr(); i++)
- {
- memset(buf_temp, 0, sizeof(buf_temp));
- sprintf(buf_temp, "{\"info\":\"%s\",\"servip\":\"%s\",\"servport\":%d,\"baud\":%d,\"parity\":\"%s\",\
- \"dev\":\"%s\",\"port\":%d,\"mode\":\"%s\",\"errcnt\":%d,\"started\":%d,\
- \"restart_times\":%d,\"retry_times\":%d,\"dbg\":%d}",
- chan_get_info_str(i), chan_get_servip_str(i), chan_get_servport(i), chan_get_baud(i), chan_get_parity_str(i),
- chan_get_dev_str(i), chan_get_port(i), chan_get_mode_str(i), chan_get_errcnt(i), chan_get_started(i),
- chan_get_restart_times(i), chan_get_retry_times(i), chan_get_dbg(i));
- strcat(buf, buf_temp);
- if (i < chan_get_nbr())
- {
- strcat(buf, ",");
- }
- };
- strcat(buf, "]");
- return 0;
- }
|