123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright (c) 2018-2019 Synopsys, Inc. and/or its affiliates.
- *
- * Synopsys DesignWare MIPI CSI-2 Host controller driver.
- * SysFS components for the platform driver
- *
- * Author: Luis Oliveira <Luis.Oliveira@synopsys.com>
- */
- #include "dw-mipi-csi.h"
- #include "bm_csi_hw.h"
- static ssize_t core_version_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "v.%d.%d*\n", csi_dev->hw_version_major,
- csi_dev->hw_version_minor);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t n_lanes_store(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long lanes;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &lanes);
- if (ret < 0)
- return ret;
- if (lanes > 8) {
- dev_err(dev, "Invalid number of lanes %lu\n", lanes);
- return count;
- }
- dev_info(dev, "Lanes %lu\n", lanes);
- csi_dev->hw.num_lanes = lanes;
- return count;
- }
- static ssize_t n_lanes_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.num_lanes);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t width_store(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long width;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &width);
- if (ret < 0)
- return ret;
- dev_info(dev, "width %lu\n", width);
- csi_dev->hw.htotal = width;
- return count;
- }
- static ssize_t width_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.htotal);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t height_store(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long height;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &height);
- if (ret < 0)
- return ret;
- dev_info(dev, "hight %lu\n", height);
- csi_dev->hw.vactive = height;
- return count;
- }
- static ssize_t height_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.vactive);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t core_reset_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- /* Reset Controller and DPHY */
- phy_reset(csi_dev->phy);
- dw_mipi_csi_reset(csi_dev);
- snprintf(buffer, 10, "Reset\n");
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t data_type_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long dt;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &dt);
- if (ret < 0)
- return ret;
- if (dt < 0x18 || dt > 0x2F) {
- dev_err(dev, "Invalid data type %lx\n", dt);
- return count;
- }
- dev_info(dev, "Data type 0x%lx\n", dt);
- csi_dev->ipi_dt = dt;
- dw_mipi_csi_set_ipi_fmt(csi_dev);
- return count;
- }
- static ssize_t data_type_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->ipi_dt);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- /*******************************************/
- static ssize_t hsa_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsa;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsa);
- if (ret < 0)
- return ret;
- if (hsa > 0xFFF) {
- dev_err(dev, "Invalid HSA time %lx\n", hsa);
- return count;
- }
- dev_info(dev, "HSA time 0x%lx\n", hsa);
- csi_dev->hw.hsa = hsa;
- return count;
- }
- static ssize_t hsa_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.hsa);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t hbp_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hbp;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hbp);
- if (ret < 0)
- return ret;
- if (hbp > 0xFFF) {
- dev_err(dev, "Invalid HBP time %lx\n", hbp);
- return count;
- }
- dev_info(dev, "HBP time 0x%lx\n", hbp);
- csi_dev->hw.hbp = hbp;
- return count;
- }
- static ssize_t hbp_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.hbp);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t hsd_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsd;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsd);
- if (ret < 0)
- return ret;
- if (hsd > 0xFFF) {
- dev_err(dev, "Invalid HSD time %lx\n", hsd);
- return count;
- }
- dev_info(dev, "HSD time 0x%lx\n", hsd);
- csi_dev->hw.hsd = hsd;
- return count;
- }
- static ssize_t hsd_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.hsd);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi2_hsa_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsa;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsa);
- if (ret < 0)
- return ret;
- if (hsa > 0xFFF) {
- dev_err(dev, "Invalid HSA time %lx\n", hsa);
- return count;
- }
- dev_info(dev, "HSA time 0x%lx\n", hsa);
- csi_dev->hw.ipi2_hsa = hsa;
- return count;
- }
- static ssize_t ipi2_hsa_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi2_hsa);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi2_hbp_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hbp;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hbp);
- if (ret < 0)
- return ret;
- if (hbp > 0xFFF) {
- dev_err(dev, "Invalid HBP time %lx\n", hbp);
- return count;
- }
- dev_info(dev, "HBP time 0x%lx\n", hbp);
- csi_dev->hw.ipi2_hbp = hbp;
- return count;
- }
- static ssize_t ipi2_hbp_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi2_hbp);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi2_hsd_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsd;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsd);
- if (ret < 0)
- return ret;
- if (hsd > 0xFFF) {
- dev_err(dev, "Invalid HSD time %lx\n", hsd);
- return count;
- }
- dev_info(dev, "HSD time 0x%lx\n", hsd);
- csi_dev->hw.ipi2_hsd = hsd;
- return count;
- }
- static ssize_t ipi2_hsd_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi2_hsd);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi3_hsa_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsa;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsa);
- if (ret < 0)
- return ret;
- if (hsa > 0xFFF) {
- dev_err(dev, "Invalid HSA time %lx\n", hsa);
- return count;
- }
- dev_info(dev, "HSA time 0x%lx\n", hsa);
- csi_dev->hw.ipi3_hsa = hsa;
- return count;
- }
- static ssize_t ipi3_hsa_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi3_hsa);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi3_hbp_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hbp;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hbp);
- if (ret < 0)
- return ret;
- if (hbp > 0xFFF) {
- dev_err(dev, "Invalid HBP time %lx\n", hbp);
- return count;
- }
- dev_info(dev, "HBP time 0x%lx\n", hbp);
- csi_dev->hw.ipi3_hbp = hbp;
- return count;
- }
- static ssize_t ipi3_hbp_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi3_hbp);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi3_hsd_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long hsd;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &hsd);
- if (ret < 0)
- return ret;
- if (hsd > 0xFFF) {
- dev_err(dev, "Invalid HSD time %lx\n", hsd);
- return count;
- }
- dev_info(dev, "HSD time 0x%lx\n", hsd);
- csi_dev->hw.ipi3_hsd = hsd;
- return count;
- }
- static ssize_t ipi3_hsd_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.ipi3_hsd);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t vsa_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long vsa;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &vsa);
- if (ret < 0)
- return ret;
- if (vsa > 0x3FF) {
- dev_err(dev, "Invalid VSA period %lx\n", vsa);
- return count;
- }
- dev_info(dev, "VSA period 0x%lx\n", vsa);
- csi_dev->hw.vsa = vsa;
- return count;
- }
- static ssize_t vsa_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.vsa);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t vbp_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long vbp;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &vbp);
- if (ret < 0)
- return ret;
- if (vbp > 0x2FF) {
- dev_err(dev, "Invalid VBP period %lx\n", vbp);
- return count;
- }
- dev_info(dev, "VBP period 0x%lx\n", vbp);
- csi_dev->hw.vbp = vbp;
- return count;
- }
- static ssize_t vbp_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.vbp);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t vfp_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long vfp;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &vfp);
- if (ret < 0)
- return ret;
- if (vfp > 0x3ff) {
- dev_err(dev, "Invalid VFP period %lx\n", vfp);
- return count;
- }
- dev_info(dev, "VFP period 0x%lx\n", vfp);
- csi_dev->hw.vfp = vfp;
- return count;
- }
- static ssize_t vfp_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%x\n", csi_dev->hw.vfp);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi_enable_mask_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long enable_mask;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 16, &enable_mask);
- if (ret < 0)
- return ret;
- dev_info(dev, "enable_mask 0x%lx\n", enable_mask);
- if (enable_mask & 1) {
- csi_dev->hw.ipi1_en = true;
- } else {
- csi_dev->hw.ipi1_en = false;
- }
- if (enable_mask & 2) {
- csi_dev->hw.ipi2_en = true;
- } else {
- csi_dev->hw.ipi2_en = false;
- }
- if (enable_mask & 4) {
- csi_dev->hw.ipi3_en = true;
- } else {
- csi_dev->hw.ipi3_en = false;
- }
- dw_mipi_csi_start(csi_dev);
- printk("enable mask is %lx\n", enable_mask);
- return count;
- }
- static ssize_t ipi_enable_mask_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- unsigned long enable_mask = 0;
- if (csi_dev->hw.ipi1_en == true) {
- enable_mask |= 1;
- }
- if (csi_dev->hw.ipi2_en == true) {
- enable_mask |= 2;
- }
- if (csi_dev->hw.ipi3_en == true) {
- enable_mask |= 4;
- }
- snprintf(buffer, 10, "%lx\n", enable_mask);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t virtual_channel_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long virtual_ch;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &virtual_ch);
- if (ret < 0)
- return ret;
- if ((signed int)virtual_ch < 0 || (signed int)virtual_ch > 8) {
- dev_err(dev, "Invalid Virtual Channel %lu\n", virtual_ch);
- return count;
- }
- dev_info(dev, "Virtual Channel %lu\n", virtual_ch);
- csi_dev->hw.virtual_ch = virtual_ch;
- return count;
- }
- static ssize_t virtual_channel_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.virtual_ch);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi2_virtual_channel_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long virtual_ch;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &virtual_ch);
- if (ret < 0)
- return ret;
- if ((signed int)virtual_ch < 0 || (signed int)virtual_ch > 8) {
- dev_err(dev, "Invalid Virtual Channel %lu\n", virtual_ch);
- return count;
- }
- dev_info(dev, "Virtual Channel %lu\n", virtual_ch);
- csi_dev->hw.ipi2_virtual_ch = virtual_ch;
- return count;
- }
- static ssize_t ipi2_virtual_channel_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.ipi2_virtual_ch);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi3_virtual_channel_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long virtual_ch;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &virtual_ch);
- if (ret < 0)
- return ret;
- if ((signed int)virtual_ch < 0 || (signed int)virtual_ch > 8) {
- dev_err(dev, "Invalid Virtual Channel %lu\n", virtual_ch);
- return count;
- }
- dev_info(dev, "Virtual Channel %lu\n", virtual_ch);
- csi_dev->hw.ipi3_virtual_ch = virtual_ch;
- return count;
- }
- static ssize_t ipi3_virtual_channel_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.ipi3_virtual_ch);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi_color_mode_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long ipi_color_mode;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &ipi_color_mode);
- if (ret < 0)
- return ret;
- if ((signed int)ipi_color_mode < 0 || (signed int)ipi_color_mode > 1) {
- dev_err(dev,
- "Wrong Color Mode %lu, (48 bits -> 0 or 16 bits -> 1\n",
- ipi_color_mode);
- return count;
- }
- dev_info(dev, "IPI Color mode %lu\n", ipi_color_mode);
- csi_dev->hw.ipi_color_mode = ipi_color_mode;
- return count;
- }
- static ssize_t ipi_color_mode_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.ipi_color_mode);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi_auto_flush_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long ipi_auto_flush;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &ipi_auto_flush);
- if (ret < 0)
- return ret;
- if ((signed int)ipi_auto_flush < 0 || (signed int)ipi_auto_flush > 1) {
- dev_err(dev,
- "Invalid Auto Flush Mode %lu, (No -> 0 or Yes -> 1\n",
- ipi_auto_flush);
- return count;
- }
- dev_info(dev, "IPI Auto Flush %lu\n", ipi_auto_flush);
- csi_dev->hw.ipi_auto_flush = ipi_auto_flush;
- return count;
- }
- static ssize_t ipi_auto_flush_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.ipi_auto_flush);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t ipi_timings_mode_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long ipi_mode;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &ipi_mode);
- if (ret < 0)
- return ret;
- if ((signed int)ipi_mode < 0 || (signed int)ipi_mode > 1) {
- dev_err(dev,
- "Invalid Timing Source %lu (Camera:0|Controller:1)\n",
- ipi_mode);
- return count;
- }
- dev_info(dev, "IPI Color mode %lu\n", ipi_mode);
- csi_dev->hw.ipi_mode = ipi_mode;
- return count;
- }
- static ssize_t ipi_timings_mode_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.ipi_mode);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t output_type_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long output;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &output);
- if (ret < 0)
- return ret;
- if ((signed int)output < 0 || (signed int)output > 1) {
- dev_err(dev,
- "Invalid Core output %lu to be used \
- (IPI-> 0 or IDI->1 or BOTH- 2\n",
- output);
- return count;
- }
- dev_info(dev, "IPI Color mode %lu\n", output);
- csi_dev->hw.output = output;
- return count;
- }
- static ssize_t output_type_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- char buffer[10];
- snprintf(buffer, 10, "%d\n", csi_dev->hw.output);
- return strlcpy(buf, buffer, PAGE_SIZE);
- }
- static ssize_t csi_power_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- int ret;
- unsigned long on;
- struct platform_device *pdev = to_platform_device(dev);
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- ret = kstrtoul(buf, 10, &on);
- if (ret < 0)
- return ret;
- dw_mipi_csi_s_power(csi_dev, on);
- printk("csi set power: %lu\n", on);
- return count;
- }
- static DEVICE_ATTR_RO(core_version);
- static DEVICE_ATTR_RO(core_reset);
- static DEVICE_ATTR_RW(n_lanes);
- static DEVICE_ATTR_RW(width);
- static DEVICE_ATTR_RW(height);
- static DEVICE_ATTR_RW(data_type);
- static DEVICE_ATTR_RW(hsa);
- static DEVICE_ATTR_RW(hbp);
- static DEVICE_ATTR_RW(hsd);
- static DEVICE_ATTR_RW(vsa);
- static DEVICE_ATTR_RW(vbp);
- static DEVICE_ATTR_RW(vfp);
- static DEVICE_ATTR_RW(virtual_channel);
- static DEVICE_ATTR_RW(ipi_color_mode);
- static DEVICE_ATTR_RW(ipi_auto_flush);
- static DEVICE_ATTR_RW(ipi_timings_mode);
- static DEVICE_ATTR_RW(output_type);
- static DEVICE_ATTR_WO(csi_power);
- static DEVICE_ATTR_RW(ipi2_virtual_channel);
- static DEVICE_ATTR_RW(ipi3_virtual_channel);
- static DEVICE_ATTR_RW(ipi_enable_mask);
- static DEVICE_ATTR_RW(ipi2_hsa);
- static DEVICE_ATTR_RW(ipi2_hbp);
- static DEVICE_ATTR_RW(ipi2_hsd);
- static DEVICE_ATTR_RW(ipi3_hsa);
- static DEVICE_ATTR_RW(ipi3_hbp);
- static DEVICE_ATTR_RW(ipi3_hsd);
- int dw_csi_create_capabilities_sysfs(struct platform_device *pdev)
- {
- device_create_file(&pdev->dev, &dev_attr_core_version);
- device_create_file(&pdev->dev, &dev_attr_core_reset);
- device_create_file(&pdev->dev, &dev_attr_n_lanes);
- device_create_file(&pdev->dev, &dev_attr_height);
- device_create_file(&pdev->dev, &dev_attr_width);
- device_create_file(&pdev->dev, &dev_attr_data_type);
- device_create_file(&pdev->dev, &dev_attr_hsa);
- device_create_file(&pdev->dev, &dev_attr_hbp);
- device_create_file(&pdev->dev, &dev_attr_hsd);
- device_create_file(&pdev->dev, &dev_attr_vsa);
- device_create_file(&pdev->dev, &dev_attr_vbp);
- device_create_file(&pdev->dev, &dev_attr_vfp);
- device_create_file(&pdev->dev, &dev_attr_virtual_channel);
- device_create_file(&pdev->dev, &dev_attr_ipi_color_mode);
- device_create_file(&pdev->dev, &dev_attr_ipi_auto_flush);
- device_create_file(&pdev->dev, &dev_attr_ipi_timings_mode);
- device_create_file(&pdev->dev, &dev_attr_output_type);
- device_create_file(&pdev->dev, &dev_attr_csi_power);
- device_create_file(&pdev->dev, &dev_attr_ipi2_virtual_channel);
- device_create_file(&pdev->dev, &dev_attr_ipi3_virtual_channel);
- device_create_file(&pdev->dev, &dev_attr_ipi_enable_mask);
- device_create_file(&pdev->dev, &dev_attr_ipi2_hsa);
- device_create_file(&pdev->dev, &dev_attr_ipi2_hbp);
- device_create_file(&pdev->dev, &dev_attr_ipi2_hsd);
- device_create_file(&pdev->dev, &dev_attr_ipi3_hsa);
- device_create_file(&pdev->dev, &dev_attr_ipi3_hbp);
- device_create_file(&pdev->dev, &dev_attr_ipi3_hsd);
- return 0;
- }
- int dw_csi_remove_capabilities_sysfs(struct platform_device *pdev)
- {
- device_remove_file(&pdev->dev, &dev_attr_core_version);
- device_remove_file(&pdev->dev, &dev_attr_core_reset);
- device_remove_file(&pdev->dev, &dev_attr_n_lanes);
- device_remove_file(&pdev->dev, &dev_attr_height);
- device_remove_file(&pdev->dev, &dev_attr_width);
- device_remove_file(&pdev->dev, &dev_attr_data_type);
- device_remove_file(&pdev->dev, &dev_attr_hsa);
- device_remove_file(&pdev->dev, &dev_attr_hbp);
- device_remove_file(&pdev->dev, &dev_attr_hsd);
- device_remove_file(&pdev->dev, &dev_attr_vsa);
- device_remove_file(&pdev->dev, &dev_attr_vbp);
- device_remove_file(&pdev->dev, &dev_attr_vfp);
- device_remove_file(&pdev->dev, &dev_attr_virtual_channel);
- device_remove_file(&pdev->dev, &dev_attr_ipi_color_mode);
- device_remove_file(&pdev->dev, &dev_attr_ipi_auto_flush);
- device_remove_file(&pdev->dev, &dev_attr_ipi_timings_mode);
- device_remove_file(&pdev->dev, &dev_attr_output_type);
- device_remove_file(&pdev->dev, &dev_attr_csi_power);
- device_remove_file(&pdev->dev, &dev_attr_ipi2_virtual_channel);
- device_remove_file(&pdev->dev, &dev_attr_ipi3_virtual_channel);
- device_remove_file(&pdev->dev, &dev_attr_ipi_enable_mask);
- device_remove_file(&pdev->dev, &dev_attr_ipi2_hsa);
- device_remove_file(&pdev->dev, &dev_attr_ipi2_hbp);
- device_remove_file(&pdev->dev, &dev_attr_ipi2_hsd);
- device_remove_file(&pdev->dev, &dev_attr_ipi3_hsa);
- device_remove_file(&pdev->dev, &dev_attr_ipi3_hbp);
- device_remove_file(&pdev->dev, &dev_attr_ipi3_hsd);
- return 0;
- }
|